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The  first  major  topic  covered  in  this  dissertation  is  the  special 
(or  singular)  configurations  of  N degree  of  freedom  (DOF)  serial 
manipulators.  These  configurations  are  classified  according  to  the 
number  of  degrees  of  freedom  lost.  This  classification  yields 
hypersurfaces  in  the  joint  space,  the  union  of  which  is  designated  by 
HSC.  An  efficient  methodology  is  developed  for  the  identification  of 
each  such  hypersurface  via  Screw  Theory  and  Linear  Algebra.  The 
efficiency  of  this  methodology  stems  from  a novel  theorem  and  the 
utilization  of  the  minimal  reference  frames  which  depend  on  the  type 
and  sequence  of  the  joints.  Various  novel  concepts  associated  with 
the  HSC  are  also  introduced  and  it  is  demonstrated  that  these  concepts 
are  useful  in  the  kinematic  design,  analysis,  motion  planning  and 
control  of  manipulators. 
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The  second  major  topic  discussed  is  the  quantification  of  the 
freedom  of  the  end  effector  for  a 6 DOF  manipulator.  A computable 
measure,  which  includes  joint  limitations  and  scale,  is  introduced  for 
this  purpose.  The  computation  of  this  measure  is  considerably 
simplified  if  the  forward  displacement  mapping  is  one-to-one  when 
restricted  to  a region  which  is,  loosely  speaking,  bounded  by  the 
HSC.  Sufficient  conditions  are  derived  for  this  useful  property  and 
simple  expressions  are  obtained  for  the  upper  bound  of  the  number  of 
these  regions. 

The  reverse  velocity  analysis  of  6 DOF  manipulators  constitutes 
the  third  topic.  Efficient  and  systematic  methods,  applicable  to  any 
type  of  manipulator  with  or  without  any  special  geometry,  are 
developed.  The  relations  between  the  dimensions  of  the  manipulator 
and  the  complexity  of  the  reverse  velocity  analysis  are  also 
investigated. 

Further,  the  dissertation  contains  an  in-depth  analysis  of  the 
Planar  Wrist  manipulators  including  workspace  and  closed-form  reverse 
displacement  analyses. 
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CHAPTER  1 
INTRODUCTION 

The  kinematics  of  a serial  manipulator,  which  is  essential  for 
the  control  and  motion  planning  algorithms,  is  built  around  the 
Forward  Displacement  Mapping  (FDM)  and  the  mappings  induced  from  it. 
This  highly  nonlinear  mapping  is  from  the  joint  space  into  the 
Position  and  Orientation  Space  of  the  Hand  (POH  space)  which  is  also 
referred  to  as  the  Cartesian  space.  The  derivation  of  the  reverse 
mapping,  i.e.,  reverse  displacement  analysis,  can  be  quite  challenging 
especially  if  the  manipulator  does  not  have  a simple  geometry  (see 
Duffy,  1980). 

The  Forward  Velocity  Mapping  (FVM),  on  the  other  hand,  is  a 
linear  transformation  from  the  joint  velocity  space  into  the  hand 
twist  [(generalized)  hand  velocity]  space.  Any  matrix  which 
represents  this  transformation  is  called  a Jacobian  matrix,  [J] . The 
transpose  of  the  same  matrix  transforms  the  hand  wrench  [(generalized) 
hand  force]  into  the  (generalized)  joint  torques.  Both  of  these 
transformations  are  vital  for  almost  all  control  algorithms  and  thus 
various  methods  have  been  proposed  for  the  determination  of  [J]  (see 
Or in  and  Schrader  (1984)  for  a comprehensive  review). 

During  the  motion  of  a robot,  sometimes  the  joint  freedoms  become 
dependent  and  the  robot  loses  one  or  more  degrees  of  freedom.  Such 
configurations  are  known  as  special  (or  singular)  configurations  of 
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the  manipulator.  When  the  manipulator  is  in  a special  configuration 
the  reverse  velocity  analysis  breaks  down.  However  this  is  not 
necessarily  true  for  the  reverse  displacement  analysis.  The  special 
configurations  have  been  investigated  using  screw  theory  (see  Sugimoto 
et  al.  (1982);  Waldron  et  al.  (1985))  and  the  FDM  represented  by  4x4 
transformation  matrices  (Litvin  and  Castelli,  1985;  Litvin  et  al., 

1985;  1987).  The  question  of  "escape"  from  a special  configuration 
has  been  discussed  by  Hunt  (1986). 

The  workspace  of  a manipulator  is  also  closely  related  to  the 
FDM.  After  the  inspiring  paper  by  Roth  (1976),  Kumar  and  Waldron 
(1980,  1981)  identified  the  two  different  types  of  workspaces  which 
they  called  the  reachable  and  dextrous  workspaces.  They  defined  the 
reachable  workspace  to  be  the  collection  of  all  points  that  can  be 
reached  by  a reference  point  on  the  end  effector.  The  portion  of  the 
reachable  workspace  that  is  reachable  with  any  desired  orientation  of 
the  hand  was  named  as  the  dextrous  workspace.  Numerous  other 
researchers  have  also  contributed  in  this  area  (see  the  references 
contained  in  Vijaykumar  et  al.  (1986)). 

The  contents  of  the  chapters  are  described  next. 

The  special  configurations  of  an  N DOF  manipulator  can  be 
classified  according  to  the  instantaneous  number  of  degrees  of  freedom 
lost.  In  Chapter  2 it  is  demonstrated  that  this  natural 
classification  yields  hypersurfaces  in  the  joint  space  (labelled  as 
the  hypersurfaces  of  special  configurations)  the  union  of  which  is 
designated  in  short  by  HSC.  An  efficient  methodology  (via  screw 
theory  and  linear  algebra)  is  developed  for  the  identification  of  each 
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such  hypersurface.  The  efficiency  of  this  methodology  stems  from 
Theorem  2.1  and  the  utilization  of  the  minimal  reference  frames. 

These  frames  are  obtained  and  tabulated  for  all  possible  types  of  3» 

4,  5 and  6 DOF  manipulators.  Furthermore  the  adaptability  of  a 
manipulator  to  a common  control  algorithm  is  quantified  via  an 
index.  The  numerical  values  of  these  indices  are  listed  for  all 
possible  types  of  manipulators. 

Chapter  3 is  primarily  concerned  with  the  novel  concepts  related 
to  the  HSC.  In  Section  3.1  a passive  joint  is  defined  as  a joint  with 
the  property  that  when  actuated  alone  it  cannot  change  the  incidence 
relationship  between  the  joint  variable  vector  and  the  HSC.  A joint 
which  is  not  passive  is  said  to  be  an  active  joint.  The  HSC  is  at 
most  an  (A-1 ) -manifold  in  the  active  joint  space  of  the  manipulator, 
the  dimension  of  which  is  denoted  by  A.  The  lowest  upper  bounds  of  A 
for  all  possible  types  of  6 DOF  manipulators  are  determined  and 
tabulated  in  this  section.  The  results  indicate  that  these  bounds  lie 
between  1 and  4.  It  should  be  noted  that  when  A_<3  the  HSC  is  at  most 
a 2-manifold  and  it  is  thus  possible  to  visualize  the  hypersurface  of 
special  configurations. 

In  Section  3.2  the  novel  concepts  of  component/subcomponent 
manifolds  of  the  HSC,  configurations  and  subconfigurations  are 
introduced.  These  concepts  are  useful  in  the  kinematic  design, 
control  and  motion  planning  of  manipulators.  Some  applications  are 
given  in  Section  3.3. 

In  Section  3.4  a theorem  which  predicts  the  existence  of  passive 
joints  is  presented.  The  hypothesis  of  the  theorem  is  a sufficient 
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but  not  necessary  condition  for  the  existence  of  such  joints.  Hence, 
an  algorithm  for  the  synthesis  of  passive  joints  is  also  developed. 
Using  this  algorithm  it  is  possible  to  design  manipulators  with  simple 
HSC's.  In  general,  the  reverse  displacement  and  velocity  analyses 
will  be  simple  for  such  manipulators.  Finally,  in  Section  3.6  some  of 
the  concepts  introduced  in  Chapters  2 and  3 are  illustrated  by  way  of 
examples  which  include  three  existing  industrial  manipulators. 

Chapter  4 focuses  on  the  quantification  of  the  freedom  of  the  end 
effector  (considered  as  a rigid  body  in  R^)  for  a 6 DOF  manipulator. 
This  is  accomplished  by  introducing  two  different  measures,  HFN(D)  and 
M(D),  into  the  position  and  orientation  space  of  the  end  effector 
where  D denotes  a region  in  the  joint  space.  A theorem  proved  in 
Section  4.2  indicates  that  the  two  measures  are  equivalent  for  the 
spherical  wrist  (SW)  manipulators. 

The  cumulative  freedoms  of  the  end  effector  with  and  without 
joint  limitations  (CHFN-^  and  CHFNU)  can  be  determined  via  the 
HFNCCO^'s.  The  regions  CC^'s  (i  = 1 ,2, . . . ,NC)  signify  the  different 
configurations  of  the  manipulator  discussed  in  Chapter  3 and,  loosely 
speaking,  are  the  regions  bounded  by  the  subsets  of  the  HSC.  The 
performance  of  a manipulator  can  be  evaluated  on  the  basis  of  CHFN^, 
CHFN^,  |CHFN^|k  and  JCHFN^J^.  The  latter  two  measures  are  the 
normalized  versions  (with  respect  to  |l|  ) of  the  former  two  where  _1 
denotes  the  vector  of  active  linear  dimensions  of  the  manipulator. 

The  lowest  upper  bounds  of  |HFN(COi)f1  and  JCHFN^f^  are  obtained  and 
tabulated  in  Section  4.3  for  all  types  of  SW  manipulators.  In  the 


last  section,  the  concepts  introduced  in  this  chapter  are  illustrated 
via  a numerical  example  using  the  MBA  robot. 

Chapter  5 is  devoted  to  the  reverse  velocity  analysis  of  6 DOF 
manipulators  via  screw  theory.  It  has  been  demonstrated  in  Chapter  2 
that  the  special  Jacobian  matrix  [Jg],  which  transforms  the  actuator 
velocity  vector  into  the  twist  representing  the  instantaneous  motion 
of  the  hand  (formulated  in  the  base  coordinates),  can  be  expressed  as 
the  product  of  two  6x6  matrices  in  several  different  ways.  Here,  the 
components  of  these  matrices  are  explicitly  given  for  any  type  of 
6 DOF  manipulator.  The  alternative  formulations  of  [Jg]  lead  to  a 
classification  of  manipulators  based  on  their  geometrical  designs. 

The  inverse  of  [Jg]  for  any  manipulator  belonging  to  either  one  of  the 
seven  broad  classes  thus  identified  can  be  determined  by  inverting  a 
single  4x4  matrix.  All  possible  types  of  manipulators  which  contain  a 
kinematic  chain  equivalent  to  a planar  or  a spherical  pair  are  also 
investigated.  It  is  shown  that  for  these  manipulators  the  reverse 
velocity  analysis  reduces  to  the  inversion  of  a 3x3  matrix  for  which 
there  are  several  alternatives.  These  alternatives  are  exploited  to 
further  simplify  the  reverse  velocity  analysis.  Finally,  closed-form 
equations  for  the  HSC's  of  all  types  of  spherical  wrist  and  planar 
wrist  (PW)  manipulators  are  obtained.  A manipulator,  the  last  three 
links  of  which  are  kinematically  equivalent  to  a planar  pair,  is  here 
labelled  as  a planar  wrist  manipulator. 

In  Section  6.1  an  important  class  of  manipulators  (labelled  as 
the  echelon  manipulators)  which  includes,  for  instance,  the  majority 
of  the  SW  manipulators  is  identified.  It  is  then  proved  that  for  an 
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echelon  manipulator  the  FDM  is  one-to-one  when  restricted  to  a region 
COj  (i-1,2 NC). 

Section  6.2  contains  an  in-depth  analysis  of  the  PW 
manipulators.  Closed-form  reverse  displacement  analyses  of  all 
possible  types  of  PW  manipulators  are  performed  via  signed-planes 
which  are  defined  to  be  planes  in  with  unique  normals  attached  to 
them.  Using  these  analyses  it  is  demonstrated  that  the  majority  of 
the  PW  manipulators  are  echelon  manipulators.  Furthermore  the 
totality  of  the  uncertainty  and  stationary  configurations  of  each  type 
of  PW  manipulator  is  identified.  In  the  same  section,  an  efficient 
algorithm  is  developed  to  determine  the  "workspace"  of  a special 
signed-plane  (labelled  as  the  wrist  plane)  associated  with  a PW 
manipulator.  This  algorithm  is  then  extended  to  the  workspace  (of  the 
wrist  point)  of  the  SW  manipulators. 

In  the  last  section,  simple  expressions  are  developed  for  the 
upper  bound  of  the  number  of  configurations  (NC)  of  a manipulator. 
These  expressions  are  based  on  the  equations  of  the  component 
manifolds  and  a novel  theorem  and  two  corollaries  (on  the  number  of 
regions  formed  by  an  algebraic  curve)  which  are  proved  in  Appendix 
B.  The  upper  bound  of  the  number  of  configurations  for  all  types  of 
PW  and  SW  manipulators  are  obtained  and  tabulated  using  the 
aforementioned  expressions. 


CHAPTER  2 

THEORY  AND  DEVELOPMENT  OF  THE 
HYPERSURFACES  OF  SPECIAL  CONFIGURATIONS 

In  this  chapter  the  capped  and  uncapped  reference  frames,  optimal 
and  minimal  coordinate  systems  and  the  hypersurfaces  of  special 
configurations  of  different  orders  are  discussed.  Familiarity  with 
the  fundamentals  of  screw  theory  and  linear  algebra  is  assumed. 


2.1  PlUcker  Line  Coordinates  in  Different  Coordinate  Systems 

Consider  the  open  loop  spatial  structure  shown  in  Fig.  2.1.  The 

angle  between  two  successive  S (a)  vectors,  say  S,  (a  ,)  and 

— — -h  -gh 

S.  (a.  ,),  is  denoted  by  a.  . (0.  ) which  is  measured  from  S^  (a  . ) to 
— l —hi  hi  h — h — gh 

S.  (a,.)  in  a right-hand  sense  around  a^2  (S.  ).  Let  B„  (B„)  represent 
—l  —hi  —hi  — h S 8 

a right-handed  coordinate  system  whose  z and  x axes  are  parallel  to 
S (S  ) and  a (a  ),  respectively,  the  origin  being  located  at 

P p pi  — Ctp 


0g  (Og ) (see  Fig.  2.1),  where  ct8Y  = efg,  fgh, 


, ijk.  Furthermore, 


the  coordinates  of  a unit  vector  S (8  = e,  f,  ...,  k)  with  respect  to 
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A 

the  reference  frames  B and  B (o  = e,  f k)  will  be  denoted  by 

a a 

Sn  and  S.  * . 

-8, a ~8, a 

The  PlUcker  coordinates  (in  ray  order)  of  a line  g,  on  which  the 


line  bound  vector  S lies,  in  reference  frame  B.  (B.)  are 
-g  i i 


g,i 
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-g,i 
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s J 

-g,i 
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~og,i 
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^og.i 

(2.1) 
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Fig.  2.1  Open  Loop  Spatial  Structure 
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where 


S . = r . x S 
-og.i  -g,i  -g,i 


(S  j = r j x S j) 

~og ,1  ~g , i -g , i 


(2.2) 


where  r (r  j)  is  a vector,  expressed  in  B.  (B.),  from  the  origin 
g » i g » i i i 

a 

0i  (0.)  to  any  point  on  the  line  g.  For  instance  r^  ^ can  be 


conveniently  taken  as  r^  ^ 


■(S.,  S.  . + a.,  a,  . . + S..  S.  , 
ii  — i,i  hi  -hi,i  hh  — h,i 


+ 3gh  -gh  i^*  The  obJective  here  is  to  obtain  the  PlUcker  coordinates 

A 

of  the  lines  e,  f,  k in  the  reference  frames  B.  and  B,  . 

h h 

The  recursive  notation,  which  is  due  to  Lipkin  and  Duffy  (1985), 
is  summarized  in  Appendix  A.  A careful  interpretation  of  this 
notation  reveals  that 


— h,h 

= [0,0, 1]T 

S.  . 
-i.h 

0 

1  i 

II 

,T 

-s.  . , c,  . ] 
hi’  hiJ 

-j  ,h 

= [Xi,  Y.,  Zi]T 

^k,h 

• cv  v vT 

(2.3) 

and 

Q A 

— h,h 

= [0,0,1 ]T 

— g.h 

= [0, 

3g»-  °gh]T 

q a 

-f,h 

- [Y  "V  V 

r 

^e,h 

■ [v  -V  V]T 

(2.4) 

where  s 

BY 

3inaBY  3nd  °BY 

= cosagY  (BY 

= ef, 

fg,  ....  jk).  The 

two 

A 

coordinate  frames  B,  and  B, 

h h 

are 

relat ed 

by  the  rotation  matrix 

°h 

“3h 

0 

[Rh]  - 

Sh 

Ch 

0 

(2.5) 

0 
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where  c.  = cosG,,  s.  = sinG..  From  equations  (2.3),  (2.4)  and  (2.5), 
h h h h 


S.  * = [R.]S.  , = [s.  . s.  , -s.  . c.  , c,  .] 
-i,h  h -i,h  hi  h’  hi  h’  hi 


S.  » = [R.]S,  . = [X.  .,  X*  , Z.]T 
-j,h  h — j,h  hi’  hi'  i 


— k,h  [Rh]-k,h  = [Xhij’  Xhij  ’ Zij-1 


(2.6) 


and 


S . = [R.  ] 1 S * = [s  s , s c , c ]J 
— g , h h — g , h gh  h gh  h gh 


Sf.h  ‘ CV' ' Sf.h 


* - T 

= [X.  , -X.  , Z ] 

hg’  hg’  g 

* 


— e,h  [Rh]  ^e,h  [Xhgf’  ~Xhgf’  Zgf] 


(2.7) 


where  multiply  subscripted  X elements,  with  ascending  or  descending 
subscripts,  are  defined  as 


X_  . , = s.  X . + c„  Y 

fg...jk  f g...jk  f g...jk 


(2.8) 


All  the  vectors  S„  . and  S * (Y  = e,  f k)  have  thus  been 

— Y , h — Y , h 

determined.  The  corresponding  moment  vectors  S „ . and  S „ * are  best 

-oY,h  -oY,h 

found  by  taking  the  duals  of  the  components  of  S and  * . For 

— Y , h — Y , h 

example,  S _ . = [X  , , -X  . , Z ]T  and  S . * = [X  . . . , X . . . , Z . , ]T. 
-of,h  ohg’  ohg’  og  -ok,h  ohij ’ ohij’  oij 

The  dual  (see  Duffy,  1980)  of  F (where  F can  be  an  X,  Y,  Z or  X* 

Clp  • • .1 

term  with  or  without  bars,  with  single  or  multiple  subscripts  in  an 
ascending  or  descending  order)  can  be  expressed  in  the  form 


jk  9F  Q V 

? = y a • • »T 

oa8...Y  .I  IJ  3aT T 
IJ=er  IJ 


I Sv 


3F 


ag...Y 


K=e  KK  30K 


(2.9) 
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The  PlUcker  coordinates  for  the  lines  e k in  the  capped  and 

uncapped  coordinate  systems  have  been  listed  in  Table  2.1  using 
equations  (2.3),  (2.4),  (2.6)  and  (2.7). 


2.2  Optimal  Coordinate  Systems 

The  Jacobian  matrix,  [J],  of  an  N degree  of  freedom  (DOF)  serial 
manipulator  (see  Fig.  2.2)  transforms  the  actuator  velocities, 

3 ■ [$1 , Q2»  •••>  q^]  , int0  the  twist  V = [u  v]  representing  the 
instantaneous  motion  of  the  hand  and 


V = [J]  4 


(2.10) 


Here  u and  v designate  the  angular  velocity  of  the  hand  and  the 

translational  velocity  of  a reference  point  on  the  hand, 

respectively.  The  columns  of  the  Jacobian  are  the  coordinates  of  the 

screws  representing  the  instantaneous  joint  motions  1,  2 N in 

that  order.  These  screw  coordinates  can  be  obtained  using 

Table  2.1.  For  instance,  for  a fourth  R (revolute)  and  fifth  P 

(prismatic)  joint  they  can  be  expressed  by  $ = [X  , Y , Z , 

^ > 2 3 3 3 

X03’  Y03’  Z03]  and  $5,2  = C°’  °’  °’  X34’  Y34’  z3h]T  in  the  frame  V 
Utilizing  Table  2.1,  the  screws  constituting  the  columns  of  the 

Jacobian  can  be  formulated  in  any  of  the  bases  B , B B or 

12  N 

A A /s 

B1  , B2,  ....  B^,  yielding  the  various  forms  of  the  Jacobian 

A A ^ 

[J1  ] , ••••  or  CJ2],  ••.,  [J^J.  It  is  desirable  to 

determine  the  "simplest"  form  in  an  algebraic  sense,  where  the 
criterion  for  "simplicity"  can  be  conveniently  taken  as  the  total 
number  of  terms  in  the  components  of  the  Jacobian  when  none  of  the 
dimensions  of  the  robot  is  specified. 
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Table  2.1  PlUcker Coordinates  of  the  Lines  in  the  Coordinate  Systems 

B,  and  B,  . 
h h 


Coordinate  system  B : 
h 


$ 

*e,h 

$ 

f,h 

CXhgf’  ~Xhgf ' Zgf'  Xohgf’  _Xohgf’  Zogf]T 

* - * - T 

[Xhg’  _Xhg’  V Xohg*  "Xohg*  Zog] 

$ . = 
g.h 

^ gh3h’  3ghCh'  °gh’  aghCgh3h  + Shh3ghGh’  aghGgh°h 
Shh3gh3h’  agh3gh^ 

$ 

n,h 

[0,  0,  1,  0,  0,  0]T 

$ 

i,h 

[°’  ~3hi’  chi’  °»  _ahichi'  “ahi3hi]T 

$ 

J »h 

CXi’  V V Xoi’  Yoi’  Zoi]T 

$ 

*k,h 

CV  V V Xoij’  Yoij’  zoi/ 

Coordinate  system  B : 

h 


$ * = 
e,h 

CV,  -V  V V-  -V-  zogf]T 

* = 
f ,h 

[V  'V  V V 'V  VT 

$ * = 
g,h 

T 

CO*  S-v,*  G„v,*  0,  a c . , -a  ,s  , ] 

gh  gh  gh  gh’  gh  gh 

*h,h 

[0,  0,  1,  0,  0,  0]T 
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Table  2.1 — continued. 


!i,h  ' [3hiV  -3tuV  °hi’  ahi°hi3h  * shh3hi°i,’  •ahi°hi°h  * 

Shh3hl3h’  ”ahi3hi^ 


$ 3 
j 


k,h 


CXhi'  Xhi’  V Xohi’  Xohi’  Zoi] 

[Xhij  ’ Xhij  ’ Zij’  Xohij  ’ Xohij  ’ Zoij]T 


Fig.  2.2  A General  Manipulator 
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The  first  step  towards  the  solution  is  the  calculation  of  the 
number  of  terms  involved  in  the  expansions  of  the  recursive  notations 
given  in  Appendix  A.  Let  X(i),  X*(i),  Y(i)  and  Z(i)  designate  the 
number  of  terms  in  the  expansions  of  an  X,  X*,  Y and  Z with  i 
subscripts,  where  the  subscripts  can  be  in  an  ascending  or  descending 
order.  Then,  the  recursive  relations 

X(i  + 1)  = X*(i  + 1)  = X ( i ) + Y(i)  (2.11) 

Y(i  + 1)  = Z(i  + 1)  = X ( i ) + Y ( i ) + Z(i)  (2.12) 


can  be  used  together  with  X(1)  = 1 and  Y ( 1 ) = Z(1)  = 2 to  obtain  the 
results  listed  in  Table  2.2(a).  The  table  contains  the  number  of 
terms  in  the  P,  P*,  Q,  R,  U,  U*,  V and  W terms  also. 

Table  2.2(b)  lists  the  number  of  terms  in  the  duals  of  P,  P*,  Q, 
r»U>U,v,W,X,X,Y  and  Z,  which  are  determined  by  the  equation 


F ( i ) 
o 


= 111 

T IJ  K 


5<V 


S(V 


5uk> 


“V 


(2.13) 


where 

F:  Any  one  of  P,  P*,  Q,  R,  U,  U* , V,  W,  X,  X*,  Y,  Z. 

K:  Index  running  over  all  the  possible  subscripts  of  0. 

IJ:  Index  running  over  all  the  possible  subscripts  of  a. 

T:  Term  index  running  from  1 to  F(i). 

and 


1 (if  s exists  in  the  T’th  term  of  F) 
5(3:j)  - IJ 

0 (otherwise) 


The  variables  jfc^),  6(sK)  and  fi(c  ) are  similarly  defined. 
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Table  2.2  Number  of  Terms  in  the  Expansions  of  the  Elements  (and 
Their  Duals)  in  Appendix  A. 


(a)  Nymber  of  terms  in  the 
X , Y,  Z 

expansions 

of  P, 

* 

P , Q, 

R,  U, 

# 

u , v, 

w,  x, 

i 

1 

2 

3 

4 

5 

6 

P(i) » P*(i) , U(i),  U*(i) 

1 

2 

5 

13 

34 

89 

Q( i ) » R(i) , V(i),  W(i) 

1 

3 

8 

21 

55 

144 

X(i) , X*(i) 

1 

3 

8 

21 

55 

144 

Y(i),  Z(i) 

2 

5 

13 

34 

89 

233 

(b)  Number  of  terms  in  the 
U , V,  W,  X,  X , Y,  Z 

expansions 

of  the 

duals 

of  P, 

* 

P , Q, 

R,  U, 

i 

1 

2 

3 

4 

5 

6 

P0(1),  P*(i),  U0(i),  U*(i) 

1 

5 

20 

71 

235 

744 

Q0(i),  R0(i),  VQ(i),  WQ(i) 

2 

10 

38 

130 

420 

1308 

x0(D,  X*(i) 

2 

10 

38 

130 

420 

1308 

Y0U),  Z0(i) 

5 

20 

71 

235 

744 

2285 
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Tables  2.1  and  2.2  can  now  be  used  to  determine  the  optimal 

coordinate  systems,  B^'s,  for  all  types  of  3,  4,  5 and  6 DOF  serial 

manipulators  consisting  of  R and  P joints.  Here  the  term  "optimal’'  is 

used  in  the  sense  that  the  total  number  of  terms  in  the  Jacobian 

formulated  in  B , [J  ] , is  a minimum.  The  results  of  this 
op  op 

optimization  are  shown  in  the  fourth  and  fifth  columns  of  Table  2.3 
where  the  manipulators  are  classified  using  the  number  of  P joints. 
Groups  0 and  1...  have,  respectively,  0 and  1...  prismatic  joints. 

The  sixth  column  of  the  table  provides  the  total  number  of  terms 

A 

(TNT)  in  [J  ] , where  N denotes  the  DOF  of  the  manipulator.  This 
number  is  an  excellent  indicator  of  the  computational  effort  required 
to  generate  the  Jacobian  of  a given  type  of  manipulator  with 
completely  general  dimensions.  In  order  to  facilitate  the  comparison 
of  different  types  of  manipulators,  the  normalized  Hand  Jacobian 
Performance  Index,  abbreviated  by  HJPI,  is  defined  as 

TNT  in  [J„+1l  for  the  given  manipulator  type 

HJPI  = (2.14) 

TNT  in  [JN+^]  for  the  basis  manipulator  type 

where  the  basis  manipulator  types  are  PPP,  PPPR,  PPPRR  and  PPPRRR  for 
3,  4,  5 and  6 DOF  robots,  respectively.  The  type  of  the  N DOF 

A 

manipulator  with  the  minimum  TNT  in  [j„  1 is  here  defined  to  be  the 

N+1 

basis  manipulator  type  for  the  N DOF  robots.  Thus  HJPI  >_  1 and  the 

numerical  value  for  an  HJPI  indicates  the  difficulty,  measured 

relative  to  the  basis  manipulator  type,  of  generating  [J  ]. 

N+1 

During  the  design  stage  of  a manipulator,  the  Hand  Jacobian 
Performance  Indices  listed  in  Table  2.3  can  be  used  for  type  synthesis 
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Table 

(a)  3 

Group 

0 

1 

2 

3 


2.3  Optimal  and  Minimal  Coordinate  Systems  and  Hand  Jacobian 
Performances  Indices  for  Serial  Manipulators. 


DOF  Manipulators 


Type 


B . B 

mi  op 


TNTfin 

[JnJ 

op 


TNTfin 


HJPI 


RRR 


B2  ’ B2 


B2  ’ B2 


13 


811 


4.20 


PRR 

RPR 

RRP 


V B2 


B2  ’ B2 


8 

13 

8 


34 

72 

82 


1 .70 
3.60 
4.10 


PPR 

PRP 

RPP 


V B2 


b2,  b3 

b2,  b2 

V B2 


8 

6 

8 


22 

32 

70 


1.10 
1 .60 
3.50 


PPP 


B2  ’ B2 


B2  ’ B2 


20 


1 .00 


19 


Table  2.3 — continued. 


(b)  4 

DOF  Manipulators 

Group 

Type 

B . 
mi 

B 

op 

TNTfin 
[J  ] 

op 

TNTtin 

[V 

HJPI 

0 

RRRR 

B2,  b3 

B2,  b3 

30 

298 

5.32 

PRRR 

* 

B3 

B3 

18 

118 

2.11 

1 

RPRR 

B3 

B3 

28 

248 

4.43 

RRPR 

B2 

B2 

28 

286 

5.11 

RRRP 

B2 

B2 

18 

296 

5.29 

PPRR 

B3 

b3.  b3 

16 

68 

1 .21 

PRPR 

B2 

B3 

18 

106 

1 .89 

2 

PRRP 

B2’  “3 

b2,  b3 

13 

116 

2.07 

RPPR 

®2  ’ s3 

B2  ’ B3 

28 

236 

4.21 

RPRP 

B3 

B2 

18 

246 

4.39 

RRPP 

B2 

b2,  b2 

16 

284 

5.07 

PPRP 

B3 

B3 

11 

66 

1 .18 

3 

PPPR 

B3 

b3,  S3 

16 

56 

1.00 

RPPP 

B2 

B2  ’ B2 

16 

234 

4.18 

PRPP 

B2 

B2 

1 1 

104 

1 .86 

20 


Table  2.3 — continued. 


(c)  5 

DOF  Manipulators 

TNTfin 

TNT f in 

Group 

Type 

% 

B 

op 

C J 1 

op 

cv 

HJPI 

0 

RRRRR 

V B3 

63 

987 

6.29 

PRRRR 

B3 

8 3 

38 

387 

2.46 

RPRRR 

B3  - 

B3  - 

58 

807 

5.14 

1 

RRPRR 

53'  B3 

?3’  B3 

63 

937 

5.97 

RRRPR 

-3 

B3 

58 

975 

6.21 

RRRRP 

B3 

B3 

38 

985 

6.27 

PPRRR 

53 

B4 

31 

207 

1 .32 

PRRPR 

®3 

B3 

36 

375 

2.39 

PRPRR 

B4 

B3 

38 

337 

2.15 

RPPRR 

B3  - 

58 

757 

4.82 

2 

PRRRP 

B3'  ?3 

V B3 

26 

385 

2.45 

RPRPR 

B3'  B3 

53'  B3 

56 

795 

5.06 

RRPPR 

B2 

53 

58 

925 

5.89 

RRPRP 

B2 

53 

38 

935 

5.96 

RPRRP 

U 

B3 

36 

805 

5.13 

RRRPP 

B3 

B2 

31 

973 

6.20 

PPRRP 

-3 

B3 

21 

205 

1.31 

PPPRR 

B4 

B4  . 

29 

157 

1 .00 

PPRPR 

®3 

B3’  B4 

31 

195 

1 .24 

PRPPR 

B3  - 

03  - 

36 

325 

2.07 

3 

PRPRP 

B3  ’ ®3 

V 53 

26 

335 

2.13 

RPPPR 

B3'  B3 

53'  B3 

56 

745 

4.75 

RPPRP 

B3 

B3  - 

36 

755 

4.81 

RPRPP 

B3 

V B3 

31 

793 

5.05 

RRPPP 

B2 

5a 

29 

923 

5.88 

PRRPP 

B3 

B3 

21 

373 

2.38 

21 


Table  2.3 — continued. 


(d)  6 

DOF  Manipulators 

TNTfin 

TNTfin 

Group 

Type 

Bmi 

B 

op 

[Jnn] 

op 

U7] 

HJPI 

0 

RRRRRR 

V B« 

-=r 
< CO 

on 

CO 

126 

3128 

7.11 

PRRRRR 

®4 

B4 

76 

1220 

2.77 

RPRRRR 

?4 

B4 

114 

2528 

5.75 

1 

RRPRRR 

B4 

B4 

124 

2948 

6.70 

RRRPRR 

B3 

B3 

124 

3078 

7.00 

RRRRPR 

B3 

B3 

114 

3116 

7.08 

RRRRRP 

B3 

B3 

76 

3126 

7.10 

PPRRRR 

~3 

B4 

59 

620 

1 .41 

PRRRPR 

B4 

24 

71 

1208 

2.75 

PRPRRR 

B4 

74 

1040 

2.36 

PRRPRR 

h 

B4 

76 

1170 

2.66 

RPPRRR 

B4 

B4 

112 

2348 

5.34 

RPRPRR 

B4  . 

B4  . 

114 

2478 

5.63 

2 

PRRRRP 

B3’  ?4 

B3  ’ B4 

51 

1218 

2.77 

RPRRPR 

V ?4 

B3’  ®4 

109 

2516 

5.72 

RRPPRR 

B3  ’ B4 

B3’  B4 

124 

2898 

6.59 

RRPRPR 

B3 

B3 

114 

2936 

6.67 

RRRPPR 

h 

B3 

112 

3066 

6.97 

RRPRRP 

B4 

B3 

76 

2946 

6.70 

RRRPRP 

B3 

B3 

74 

3076 

6.99 

RPRRRP 

?3 

h 

71 

2526 

5.74 

RRRRPP 

B4 

B3 

59 

3114 

7.08 

22 


Table  2.3 — continued. 


(d)  6 DOF  Manipulators — continued 

TNT  "'"in 

TNTfin 

Group  Type 

Bmi 

B 

op 

[Jn] 

op 

W?] 

HJPI 

PPRRRP 

03 

B4 

39 

618 

1 .40 

PRPRRP 

A 

B4 

B4 

49 

1038 

2.36 

PPPRRR 

V B-« 

B4 

54 

440 

1 .00 

PPRRPR 

B3 

B4 

57 

608 

1 .38 

PPRPRR 

b3.  b„ 

B4 

59 

570 

1 .30 

PRPRPR 

V B4 

B4 

69 

1028 

2.34 

PRRPPR 

B3’  B4 

B4 

71 

1158 

2.63 

PRPPRR 

B4 

A 

B4 

74 

990 

2.25 

RPPRPR 

B3 

B4 

107 

2336 

5.31 

3 RPPPRR 

A 

B4 

B4 

112 

2298 

5.22 

RRPPPR 

B3 

B3 

112 

2886 

6.56 

RPRPPR 

B4 

B3 

107 

2466 

5.60 

RRPPRP 

B3 

B3 

74 

2896 

6.58 

RPPRRP 

V B4 

B3 

71 

2346 

5.33 

RPRPRP 

V B4 

B3 

69 

2476 

5.63 

RRPRPP 

B3*  B4 

B3 

59 

2934 

6.67 

RPRRPP 

b4 

B3 

57 

2514 

5.71 

RRRPPP 

V B4 

/\ 

B3 

54 

3064 

6.96 

PRRPRP 

B3 

B3 

49 

1168 

2.65 

PRRRPP 

B4 

B3 

39 

1206 

2.74 

^ : Components  of 

the  Jacobian 

which  are 

zero  do  not 

contribute 

to 

the  total  number  of  terms. 


purposes,  provided  that  the  control  algorithm  to  be  implemented  takes 
advantage  of  [J  ] . Since  the  indices  provide  a quantitative  measure, 
it  is  also  possible  to  make  trade-offs  between  different  types  due  to 
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other  design  constraints.  Here  [J  ] and  [J  ] designate  the  two 


respectively,  where  v_  is  the  translational  velocity  of  a fixed 

reference  point  on  the  end  effector. 

The  Jacobian  [J  ] cannot  be  obtained  directly  by  using  one  of  the 

capped  or  uncapped  coordinate  systems.  However,  the  screw 

transformation  matrix  (see  Yuan  and  Freudenstein,  1971;  Sugimoto  and 

Matsumoto,  1984)  can  be  conveniently  used  to  transform  either  one  of 

the  natural  Jacobians  [J.]  or  [J.]  (i  = 1,  2,  ...,  N)  into  [j  ] . 

An  alternative  derivation  of  the  screw  transformation  matrix, 

[b$  ],  relating  the  coordinates  of  a screw  $ in  the  reference  frames 
a e 

a and  b via  the  equation 

h = cb$j 

e , d a e,a 

indicates  that  this  matrix  can  be  represented  in  the  following  two 
different,  but  equivalent,  forms: 


B 


Jacobians  which  yield  V = [co  v]^  in  the  hand  and  base  coordinates, 


[0] 


(2.15) 


[bRj 

a a 


[0] 


(2.16) 


[V  [\]  [\] 
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where  the  skew  symmetric  matrices  [E  ] and  [E  ] are  given  by 

a b 


[Ea:  - 


m 


-1 


-ra 

c 

0 

k 


-k 


(2.17) 


[V 


m. 


-1, 


-mt 

0 

k. 


(2.18) 


1 I 

with  [ka>  1&,  ma]  and  [k^,  1^,  ra^]  being  the  coordinates  of  the 
vector  from  0^  to  0a,  r^a,  in  the  a'th  and  b'th  coordinate  systems, 
respectively.  Furthermore,  [bR  ] denotes  the  3 x 3 rotation  matrix 

cl 

converting  the  coordinates  of  a vector  in  the  a'th  system  to  the 

coordinates  in  the  b'th  system.  Either  one  of  the  forms  of  [b$  ] can 

a 

be  used.  This  depends  on  the  coordinate  system  used  to  express  r 

-ba 

It  should  be  noted  that  from  equations  (2.15)  and  (2.16) 


cay  - cb*a]-’ 


or 


[aV  - [\]_1 


CbRa]T 

1 — 1 

0 

1  1 

[E]T  [bR  ]T 

d cl 

‘V 

1 — 1 
0 
1 — 1 

1 

cV  ^b]T 

cv 

(2.19) 


(2.20) 


Here,  [bR  ]T  = CbR  ]_1  = [aR  ]. 

d a d 
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The  Jacobian  [J0]  can  now  be  determined  from  either  of  the 
equations 


cv  ■ [Bv  [V 
[v  ■ [8*h]  tv 

where  h = 1,  2,  N (see  Chapter  5). 


(2.21 ) 
(2.22) 


2.3  Hypersurfaces  of  Special  Configurations 
2.3.1  Minimal  Coordinate  Systems 

An  N DOF  manipulator  is  said  to  be  in  a special  configuration, 
sometimes  referred  to  as  a singular  configuration,  whenever  the  screws 
constituting  the  columns  of  the  Jacobian  become  dependent.  This  is 
equivalent  to  saying  that  instantaneously  the  order  of  the  screw 
system  (see  Sugimoto  and  Duffy,  1982),  which  is  defined  as  the  number 
of  screws  in  its  base,  is  strictly  less  than  N.  Hence  the  robot  loses 
at  least  one  of  its  degrees  of  freedom. 


For  a set  of  N 

3crews 

, $ , , . 

...  . $ . with  2 < N < 6.  let 

e h 

k m 

us  define  G (e,  h,  . 

. . , k , 

m)  by 

a 

G (e, 

h,  . . 

.,  k,  m)  = 

|[g  ]T  Eg  ]| 

(2.23) 

a 

'a  a 1 

where 

[g  ] = 

$ 

$.  ... 

• . • $ 

(2.2M) 

a 

e,a 

h,a 

k,a  m,a 

Clearly,  G (e,  h,  ...,  k,  m)  is  the  Gramian  of  the  screws  $ , , 

ot  eh 


26 


....  , $ computed  in  the  coordinate  system  B . Hence,  it  follows 

km  a 

immediately  that  these  screws  are  dependent  if  and  only  if 


G^e,  h,  k,  m)  = 0 (2.25) 

Since  dependency,  or  independency,  of  a set  of  screws  is  invariant 

with  respect  to  coordinate  transformations,1  any  coordinate  system  can 

be  used  in  equation  (2.25).  However,  it  is  important  to  note  that  in 

general  G (e,  h,  ...,  k,  m)  * G (e,  h,  ...,  k,  m)  unless  the  B’th 
a p 

coordinate  system  can  be  obtained  from  the  ct'th  one  by  a pure 

rotation.  Furthermore,  for  N=6  equation  (2.23)  yields 

G (1,  2,  ...,  5,  6)  = |J  I , which  is  invariant  with  respect  to  all 
a 'a 

coordinate  transformations.  These  results  can  be  obtained  by 
expanding  the  determinant 


Gg(e,  h, 


k,  m)  = | [g  ]T  [S$  ]T  [8$  ] [g  ]| 
1 a a a a 1 


(2.26) 


g 

utilizing  the  definition  of  [ $ ] from  either  of  the  equations  (2.15) 

a 

or  (2.16). 

Consider  now  the  equation 


I=KCN 


1=1 


fj 


G({D;K}) 
a 1 


= 0 


(2.27) 


for  an  N DOF  manipulator  where  D = {1,  2,  ...,  N}  and  { D ; K} ^ denotes 
the  I'th  combination  of  the  elements  of  the  set  D taken  K at  a time. 


1 


"Coordinate  transformations"  refer  to  translations  and  rotations 
only. 
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If  this  equation  can  be  represented  as  (G)b  = 0 for  an  integer  b > 2, 
it  should  be  replaced  by  G = 0.  Equation  (2.27)  defines  a hyper- 
surface in  the  joint  space  of  the  manipulator.  This  surface  will  be 
called  the  hypersurface  of  special  configurations  of  order  K which 
will  be  abbreviated  by  HSC-K.  It  follows  from  this  definition  that 
whenever  the  joint  displacement  vector,  _q,  satisfies  equation  (2.27) 
(i.e.,  is  on  HSC-K)  the  order  of  the  screw  system  defined  by  the 
joint  screws  of  the  manipulator  becomes  strictly  less  than  K. 

Obviously,  HSC-2  c HSC-3  c c HSC-N.  Further  the  manipulator 

has  exactly  K degrees  of  freedom  whenever  _q  e [HSC-(K+1 ) \ HSC-K] 
where  K = N,  N-1 , ...  and  \ denotes  the  "subtraction"  operation  of 
sets.  For  notational  convenience  HSC-N  will  simply  be  called  the 
hypersurface  of  special  configurations  (HSC) . It  should  be  noted  that 
here  the  terminology  "hypersurface"  is  used  loosely. 

By  using  different  coordinate  systems,  B^'s,  for  the  different 
terms  in  equation  (2.27),  distinct  closed-form  equations  are  obtained 
for  the  HSC-K.  These  equations  can  be  used  to  advantage  in  order  to 
reduce  the  amount  of  work  involved  in  the  determination  of  HSC-K. 

This  work  may  be  considerable,  especially  for  robots  having  general 
dimensions. 

Let  the  I’th  term  of  equation  (2.27)  be  G^(e,  h k,  m) . 

The  coordinate  system  which  minimizes  the  number  of  terms  (before  any 

simplifications)  in  G (e,  h k,  m)  will  be  said  to  be  the  minimal 

a 

coordinate  system,  Bffli , for  the  I’th  term.  If  all  the  terms  are 

formulated  in  their  respective  B 's,  then  the  equation  obtained  will 

mi 

be  called  the  minimal  equation  of  the  HSC-K.  This  is  the  most 
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convenient  equation  for  the  HSC-K  (K  = 6,  5,  ...).  For  instance,  for 
a general  6R  robot  the  number  of  terms  (before  any  simplifications)  in 
the  equation  for  the  HSC  is  0.000013824  x io9,  0.16811736  x 10^  and 
4.9241043  x 10^,  respectively,  when  the  coordinate  systems  (the 

A A 

minimal  coordinate  system),  B1  and  B^  are  used  in  equation  (2.27).  It 

should  be  recalled  that  for  the  particular  case  of  K = 6 all  of  the 

equations  for  the  HSC-6  reduce  to  the  same  equation  after  regrouping 

of  terms  and  introduction  of  trigonometric  identities. 

For  a set  of  screws  $ $ ...,  $ $ , where  e,  h k,  ra 

0 n k rn 

is  a set  of  successive  integers,  the  minimal  coordinate  system  for 
G^(e,  h,  ...,  k,  m)  can  be  readily  determined  using  Table  2.3  by 
appropriately  incrementing  the  subscript  of  the  minimal  coordinate 
system  shown  there.  For  example,  Bmi  for  0^3,  4,  5,  6),  where  the 
third,  fourth  and  sixth  joints  are  prismatic  and  the  fifth  one  is 

a 

revolute,  is  B . This  result  is  obtained  simply  by  incrementing  the 

subscript  of  B^ , the  minimal  coordinate  system  for  a PPRP  manipulator, 

by  2.  When  e,  h k,  m fails  to  be  a successive  set,  B . can  be 

mi 

determined  utilizing  Tables  2.1  and  2.2. 

2.3.2  Determining  Equations 

In  this  section  it  will  be  proved  that  when  K < N there  exists  N 

equations  which  are  equivalent  to  equation  (2.27).  This  important 

result  should  be  used  to  advantage  since  the  simplest  of  these  N 

equations  formulated  in  their  respective  minimal  coordinate  systems 

provides  the  most  convenient  equation  for  the  HSC-K.  Each  of  these  N 

equations,  which  is  of  the  form  of  equation  (2.28),  has  c,  less 

K N"1 

G2(...)  terms  than  (2.27). 
a 
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Theorem  2.1:  If  N > 3 and  2 < K < N-1 , then  the  equation 


C 

K-1  N-1 

l G ^(E  U { D \ E;  K-1} .)  = 0, 

T a Gt  d 


(2.28) 


where  E designates  any  singleton  subset  of  D = {1,  2,  N} , is 

equivalent  to  (2.27)  which  is  repeated  below  for  convenience. 


Proof:  It  is  clear  that  equation  (2.28)  is  true  whenever  equation 

(2.27)  is  true.  However,  in  order  to  prove  that  (2.28)  implies  (2.27) 
it  is  necessary  to  show  that 


provided  that  equation  (2.28)  is  satisfied.  Here  (and  throughout  the 
rest  of  the  proof)  the  subscript  a is  dropped  for  convenience,  because 
the  proof  does  not  depend  on  the  bases  used  to  formulate  the  Gramians 
defined  in  equation  (2.23).  The  proof  is  divided  into  2 cases.  In 
the  first  case  K = N-1  and  in  the  second  one  2 <_  K £ N-2. 

Case  1 : K = N-1 

Without  loss  of  generality  let  E = {1}.  Now,  equation  (2.28)  implies 
that  all  possible  combinations  of  the  screws  $ , $ , ...,  $ (which 


l G2({D;K}t)  = 0 
1=1  a 1 


(2.27) 


G2({D\E;  K}h)  = 0 


(2.29) 


2 


N 
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+ 


a(N-1)1$1  + a(N-1)2$2 


+ 


T 

where  $q  is  the  zero  screw  (i.e.f  $q  = [0,  0,  0,  0,  0,  0]  ) and  at 


least  2 of  the  a.,  's  for  each  i = 1,  2,  ....  N-1  are  nonzero.  This 
ik 

last  assertion  is  a consequence  of  the  fact  that  none  of  the  screws 
$1f  $2 , ....  is  the  zero  screw.  Equation  (2.29),  on  the  other 


which  is  the  claim  that  has  to  be  proved.  Let  NZ  denote  the  number  of 


invariant  when  each  equation  in  the  set  (2.30)  is  multiplied  by  a 
nonzero  real  number.  Now  consider  the  3 cases  NZ  _>  2,  NZ  = 1 and 
NZ  = 0. 

(a)  NZ  >_  2:  Without  loss  of  generality,  let  a^ ^ = a = 0.  Then, 
from  the  first  and  second  equations  of  the  set  (2.30)  we  get 


• • • f 


are  dependent, 

N~  1 N 


zeros  in  the  set  {a^,  a21 


• • • f 


a i . _ . ..}  and  note  that  NZ  stays 
(N-1  ) 1 


(2.31  ) 


+ 


(2.32) 
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which  yield  a22$2  ♦ + (a^  + a^  + (a^  + a25)$5  + ...  ♦ 

^aiN  + a2N^N  = Wh6n  added  together.  If  a22  * 0 or  a^  * 0 or  at 

least  one  of  the  suras  (a  + a ) for  j = 4,  5 N is  nonzero, 

then  the  screws  $2>  $3 are  dependent.  Hence,  the  only 

remaining  possibility  for  these  screws  to  be  independent  is  when 

a22  = ai3  = 0 and  (aij  + a2j)  = 0 for  J = 5,  ....  N.  But 

aij  + a2j  = 0 imPlies  either  a^  « a^  • 0 or  a ■ -a^ . Since  all 
of  a , a^,  ...,  a1N  cannot  be  zero  simultaneously,  there  is  at  least 
one  case  such  that  a^  = -a  * 0.  Let  this  be  the  case,  for 
instance,  for  (a^  + a^);  i.e.,  a^  + a24  = 0;  al4  * 0;  a24  * 0. 
Multiplying  equation  (2.31)  by  any  X * 0 and  adding  to  (2.32)  we 
obtain  0$2  + 0$3  + (Xa^  + a2i|)$4  + 0$5  + •••  + 0$N  = $ . Clearly 

Xai4  + a24  56  °»  and  hence  the  screws  $2,  $3 $N  have  to  be 

dependent. 

(b)  NZ  = 1 : Without  loss  of  generality,  let  a^  1 =0.  Then,  from  the 

first  equation  of  the  set  (2.30),  it  follows  that  $ , $N  (and 

hence  $2>  $ , ...,  $^)  are  dependent. 

(c)  NZ  = 0:1  Choose  any  two  of  the  equations,  say  the  first  two,  in 
the  set  (2.30).  Solving  for  in  each  of  the  equations  we  obtain 


1 For  N = 3 only,  the  proof  for  NZ  = 0 is  modified  as  follows. 
Equations  (2.33)  and  (2.34)  will  simplify  to 


and 


*1  ' X,*2 

*,  ’ *2*3 


(2.35) 

(2.36) 


for  some  X1  * 0,  X2  * 0.  Subtracting  (2.36)  from  (2.35)  we  get 

$ = X $ - X $ 

o V2  2 3 

which  implies  that  $2  and  $3  are  dependent. 


32 


$ = b$  + b, $,+...+  b $ 

1 3 3 4*4  N*N 


W * Vll  * - * Vn 


(2.33) 

(2.34) 


where  b^,  ...,  b^  and  d^,  . ..,  d^  are  unique.  Here,  at  least  one  of 
the  b^’s  and  one  of  the  d 's  must  be  nonzero.  Subtracting  equation 
(2.34)  from  equation  (2.33)  we  get 


-d  $ + 

2*2 


b $ + 

3 3 


% - 


VS  * 


+ (b  - d )$ 
v N V*N 


If  d^  * 0 or  b^*  0 or  at  least  one  of  the  differences  (b^  - d ) for 

i = 4,  5 N is  nonzero,  then  the  screws  $^,  . ..,  are 

dependent.  Hence,  the  only  remaining  possibility  for  these  screws  to 

be  independent  is  when  d„  = b„  = 0 and  b - d = 0 for 

2 3 i i 

i = 4,  5,  ...,  N.  Now,  suppose  b^  * 0 in  equation  (2.33).  Then 
substituting  b^  = 0 into  (2.33)  and  substituting  the  result  into  the 
third  equation  of  the  set  (2.30)  (i.e.,  the  equation  which  does  not 
contain  $^)  we  obtain 

(V*2  * <V*3  * * W * VS 

* U31b6  * VS  * •••  * (Vn  * V$N  ' S’ 

Here,  the  coefficient  of  is  nonzero.  Hence,  the  screws 
$2»  $2’  •••»  must  be  dependent. 

Case  2:  2 <_  K <_  N-2 

Consider  any  term  in  equation  (2.29),  say  the  H'th  term  G2({D\E;  K}  ). 

H 

Define  D'  = E U {D\E;  K}^  and  let  N'  = K + 1.  Then  it  can  be 
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concluded  that 

K-1CN'-1 

l G^E  U {D*  \ E;  K-1 } .)  = 0 
J-1  J 

because  all  of  the  (N'  - 1)  terms  in  the  above  summation  always  exist 
in  the  left-hand  side  of  equation  (2.28)  and  hence  have  to  be 
individually  equal  to  zero.  Therefore,  from  the  result  of  case  1,  it 
follows  that  G2({D\E;  K}„)  = 0.  Each  terra  in  equation  (2.29)  can  be 

n 

shown  to  be  equal  to  zero  using  this  procedure  and  thus  the  proof  is 
completed. 


CHAPTER  3 

CONCEPTS  RELATED  TO  THE 
HYPERSURFACES  OF  SPECIAL  CONFIGURATIONS 

In  this  chapter  the  novel  concepts  of  passive/active  joints, 
component/subcomponent  manifolds  of  the  HSC,  configurations/ 
subconfigurations  and  their  applications  are  presented.  The  chapter 
also  contains  a theorem  which  predicts  the  existence  of  passive 
joints,  a synthesis  procedure  for  passive  joints  and  illustrative 
examples. 

3.1  Passive  Joints  and  Dimensions 

It  follows  from  equation  (2.27)  that  the  HSC  is  determined  by 
|j|  = 0.  Although  | J | is  invariant  with  respect  to  all  coordinate 
transformations,  it  is  useful  to  find  expressions  for  it  in  the  ten 

A A 

bases  and  B 2 Bg . Expressions  for  |j  | and 

a 

|j^ | are  omitted  because  they  are  excessively  complicated.  Before 
proceeding  it  is  useful  to  introduce  a number  of  definitions. 

A naturally  passive  joint  is  defined  here  to  be  a joint  such  that 
when  actuated  alone,  it  cannot  change  the  order  of  the  screw  system 
determined  by  the  columns  of  the  Jacobian.  Equivalently,  actuation  of 
a naturally  passive  joint  alone  does  not  change  the  incidence 
relationship  between  q and  the  HSC  of  any  order.  Clearly,  the  first 
and  last  joints  of  a serial  manipulator  are  always  naturally 
passive.  A passive  joint  of  order  K is  defined  as  a joint  with  the 
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property  that  when  actuated  alone  it  cannot  change  the  incidence 

relationship  between  _q  and  HSC-K.  A joint  which  is  not  passive  of 

order  K will  be  said  to  be  an  active  joint^  of  order  K.  For  the  sake 

of  conciseness  these  two  types  of  joints  will  simply  be  called  passive 

and  active  when  K = N.  Finally,  it  should  be  noted  that  a passive 

joint  of  order  K is  not  necessarily  passive  of  order  F unless  K = F. 

If  all  the  HSC-K’ s (K  = 6,  5,  ...)  of  a manipulator  are  invariant 

with  respect  to  changes  in  a dimension  of  the  robot,  then  that 

dimension  will  be  called  a naturally  passive  dimension.  For  example, 

Sn  and  SNN  (0^  and  0 ) are  naturally  passive  dimensions  for  all 

manipulators  with  R (P)  joints  as  the  first  and  last  joints.  Clearly, 

regardless  of  the  type  of  the  manipulator  a,„w„  . is  naturally 

(N) (N+1 ) 

passive  as  well.  On  the  other  hand,  a passive  dimension  of  order  K is 

defined  to  be  a dimension  with  respect  to  which  HSC-K  is  invariant. 

As  in  the  case  of  passive  joints,  this  kind  of  dimension  will  simply 

be  called  a passive  one  whenever  K = N. 

Finally,  the  degrees  of  the  HSC  in  the  joint  variables  and 

dimensions  of  the  manipulator  are  defined  in  the  following  manner. 

If  P denotes  the  summation  of  the  powers  of  s.  and  c,  in  the  j ' th 
J i i J 

term  (the  power  of  S..  in  the  j ' th  term)  of  the  equation  for  the  HSC, 

and  if  the  maximum  of  P.  over  all  the  terms  is  equal  to  p,  then  the 

J 

HSC  will  be  said  to  be  of  degree  p in  the  angular  joint  variable  0^ 
(linear,  i.e.,  prismatic,  joint  variable  S^).  The  definitions  of  the 

1 The  active/passive  joints  defined  in  this  dissertation  are  geometric 
concepts,  and  they  do  not  imply  the  presence/absence  of  a motor  or 
other  primary  drive. 
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degrees  of  the  HSC  in  the  angular  and  linear  dimensions  of  the 
manipulator  can  be  obtained  by  replacing  "joint  variable"  with 
"dimension"  in  the  preceding  statement.  It  should  be  noted  that  if 
the  degree  of  the  HSC  in  a joint  variable  or  dimension  is  zero,  then 
that  joint  or  dimension  is  passive.  However,  the  converse  is  not 
necessarily  true. 

Each  of  the  Jacobian  matrices  formulated  in  the  bases 
B1  ’ B2’  B5  contains  a Pair  of  columns  of  the  form  [0  0 1 0 0 0]T 

and  [o  * * 0 * *]T  (see  Table  2.1).  Thus,  | j | (a  = 1 , 2 5)  can 

be  expressed  as  the  summation  of  three  4x4  determinants. 

lJal  = J66  M ,2,4,5;p,q,r,s|  - J2g  1 1 ,4 ,5 ,6;p,q  ,r ,s|  - J5g|l ,2,4,6;p,q,r,s 

(3.1 ) 

where 


p,  q,  r and  s are  the  integers  from  1 to  6,  excluding  a and  B,  in  an 

ascending  order;  and  |r  , r ....  r ; p , po p I is  the  short- 

hand  notation  for  the  determinant  of  the  n x n submatrix  formed  from 

the  rows  r^ , r^,  ...,  r^  and  columns  p^ , p2 p^  (in  the  given 

order)  of  [J  ] . Using  the  Laplace  expansion  of  determinants  (see,  for 
example,  Hadley,  1977),  equation  (3.1)  can  be  decomposed  into  the 
following  20  distinct  2x2  determinants. 


'11 


J12  J16 


, B = a + 1 , 


’61 


'62 


'66 
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1 1 * 4 ; p , q 1 ( 

"j2B|5’ 

6 ; r , 3 1 + 

J56  |2,6;r,s| 

"j6B  l2,5:r 

,s|  ) + 

|l »4 ;r,s | 

( "*J  2g  1 5 , 6 ; p , q | 

*J5B  l2'6;p 

,q|  - j 

6b  l2,5;P 

,q| ) 

+ 1 1 ,5 ; p ,q | 

(J2B  1 

4 ,6 ;r , s | 

- J6g  J 4 , 2 ; r , s | ) 

+ 1 1 »6;p ,q | 

(~j2g 

1 4 , 5 ; r , 3 1 

+ J5g  | 4 , 2 ; r , 3 1 ) 

+ | 4 , 5 ; p ,q  | 

("J<2B 

| 1 ,6;r,s| 

+ J6g  | 1 »2;r,s| ) 

+ | 4 , 6 ; p , q | 

(j2B  1 

2,5;r,s| 

- J5B  | 1 »2;r ,s| ) 

+ | 4 , 2; p ,q | 

(J5B  1 

1 ,6;r,s| 

- jg6  1 1 >5 ;r , s | ) 

+ 1 1 » 2;p ,q | 

('J5B 

| 4 , 6 ; r , s | 

* J6e  l«.5.P,s|) 

If  the  a'th  joint  of  the  manipulator  is  a P joint,  the  integers  5 
and  6 in  (3.1)  and  (3.2)  should  be  replaced  by  3.  4 and  5, 
respectively. 

The  right-hand  sides  of  equations  (3.1)  and  (3.2)  can  be  used  to 

obtain  I J I (ot  = 2,  3,  4,  5,  6).  Here,  6 = a -1  and  j,  denotes  the 
ct  de 

component  of  [J  ] in  the  d'th  row  and  e'th  column. 
a 

The  equation  of  the  HSC  for  any  type  of  6 DOF  manipulator  is  best 
determined  using  equation  (3.2)  together  with  Tables  2.1  and  2.3.  It 
should  be  noted  that  all  industrial  robots  have  many  angular 
dimensions  which  are  multiples  of  it  or  tt/2  and  many  linear  dimensions 
are  zero.  This  results  in  further  simplifications  and  the  expansions 
can  be  performed  manually. 

The  degree  of  the  HSC  in  any  joint  variable  or  in  any  dimension 
could  be  determined  by  fully  expanding  the  equation  of  the  HSC.  This 
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is  a tedious  and  time  consuming  process  for  a robot  with  general 

dimensions.  However,  the  apparent  degree  of  the  HSC  in  any  parameter 

(joint  variable  or  dimension)  can  be  determined  without  expanding  the 

2x2  determinants  of  equation  (3.2).  The  X,  Y,  Z and  X*  terms  are 

all  linear  in  the  sines  and  cosines  of  the  joint  variables  and 

dimensions  that  they  contain.  Using  equation  (3.2)  in  conjunction 

with  Table  2.1,  the  apparent  degree  of  the  HSC  in  any  parameter  can  be 

determined  in  each  of  the  10  bases  and  the  minimum  degree  thus 

obtained  is  selected.  The  results  for  all  possible  types  of  6 DOF 

manipulators  are  listed  in  Table  3.1.  It  is  interesting  to  note  that 

reversing  the  order  of  the  joints,  viz  PRRRRR  and  RRRRRP , reverses  the 

degrees  of  the  HSC  in  the  various  parameters.  For  instance  the 

degrees  of  a , a , a , a.1(_  and  a_r  for  the  PRRRRR  robot  are  0,  1, 

12  23  34  45  56 

2,  2 and  1 which  are  equal  to  the  degrees  of  the  HSC  in  a ,,  a,  , 

5o  45 

a34’  a23  and  ai2  f0r  the  RRRRRF>  robot*  The  degrees  of  the  HSC  in 

^22’ 2 * *  S33  ’ ^44’  ^55 * ^ai2’  a23’  °34’  a45’  a56^’  an<^  ®3’  ®4’ 

exhibit  this  same  property. 

It  is  important  to  note  that  the  degrees  shown  in  Table  3.1  are 
lowest  upper  bounds  which  may  be  achieved  when  the  robot  has 
completely  general,  arbitrary  dimensions.  The  same  comment  is  valid 
for  A,  the  dimension  of  the  active  joint  space,  shown  in  the  last 
column  of  the  table.  However,  when  the  upper  bound  of  the  degree  of  a 
joint  variable  or  dimension  is  equal  to  zero,  then  that  joint  or 
dimension  is  always  passive  regardless  of  the  other  dimensions.  For 
example  all  of  the  linear  dimensions  and  prismatic  joint  variables  of 


Table  3.1  Degrees  of  the  HSC  in  the  Joint  Variables  and  Dimensions. 
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Degrees  of  the  joint  variables  are  shown  in  parentheses. 


group  3 manipulators  are  passive.  This  fact  can  easily  be  deduced  by 
using  the  Laplace  method  to  expand  |j|  with  respect  to  the  columns 
which  represent  the  screw  coordinates  of  the  P joints.  Furthermore, 
it  follows  that  for  any  group  3 manipulator  the  |j|  is 
dimensionless.  It  can  be  shown  that  the  dimension  of  |j|  for  any 
group  2,  group  1 and  group  0 manipulator  is  (length),  (length)2  and 
(length)^,  respectively. 

3.2  Configurations  and  Component  Manifolds 

A single  equation,  F(x1  , x2>  ....  xn)  = 0,  in  the  n variables 
3 F*  oo 

*1  , X2 » • • • » xn  with  — e C for  i = 1,  2,  ...»  nwill  be  said  to 

xi 

define  an  (n-1 )-manifold,  consisting  of  the  points  satisfying 

F(x.j,  x2,  ...,  xn)  = 0,  in  Rn.  This  manifold  will  be  linear  if 

F(X1>  X2>  •••>  xn)  is  linear  in  all  of  the  n variables.  Here  the  term 

"manifold"  is  used  loosely  and  can  refer  to  arbitrary  point  sets  as 

well.  The  (n-1 )-dimensional  x , x , ...,  x.  , x.  .,  ...,  x 

i c l-ii+i  n 

slice  at  x.  = c will  denote  the  points  of  the  (n-2) -manifold  defined 
by  F (x^ , X2 , ...,  x^ ) = C end  x^  — c = 0.  If  all  possible 

X1 , X2»  •••*  xi_i » xi+i » •••»  xn  slices  yield  (n-2)-manifolds  that  can 

be  obtained  from  each  other  by  a translation  of  the  origin  along  the 

x axis,  then  the  (n-1 )-manifold  defined  by  F(x, , x„,  ...,  x ) = 0 
1 1 2 n 

will  be  said  to  be  parallel  to  the  xi  axis. 

The  HSC  of  an  N DOF  manipulator,  defined  by  equation  (2.27),  is 
an  (N-1 )-manifold  in  the  joint  space  of  the  robot.  However,  this 
(N-1 ) -manifold  is  parallel  to  the  naturally  passive  and  passive  joint 
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axes.  Therefore,  it  is  sufficient  to  analyze  it  as  an  (A-1 ) -manifold 

A 

in  R consisting  of  the  A active  joints.  Because  there  exists  2 
naturally  passive  joints,  the  first  and  the  last  ones,  for  every 
manipulator,  the  lowest  upper  bounds  of  A for  6,  5,  4 and  3 DOF 
manipulators  will  be  4,  3,  2 and  1,  respectively.  This  yields  subsets 
of  hypersurfaces,  surfaces,  curves  and  points  (3,  2,  1 and  0- 
manifolds)  as  their  HSC's.  These  upper  bounds  are  not  always  achieved 
either  due  to  the  type  of  the  manipulator  or  to  special  dimensions. 

For  instance  Table  3.1  shows  that  the  upper  bounds  of  A for  different 
types  of  6 DOF  manipulators  can  lie  between  1 and  4. 

Consider  an  A-dimensional  rectangular  hyperprism  with  2A 
hyperfaces,  each  being  a subset  of  a linear  (A-1 )-manifold,  parallel 
to  the  active  joint  axes  in  the  Euclidean  space  RA.  These  hyperfaces 
will  be  end  points,  sides,  faces  and  hyperfaces  for  A = 1,  2,  3,  4, 
respectively.  The  set  of  points  inside  a hyperprism,  denoted  by  H, 
can  be  defined  as  the  cartesian  product  of  A sets. 


I J 


H = ( TT  0.  ) X ( TT 

i-1  1 j-1 

V 

(3.3) 

where  9, 

l 

and  S . are 
0 

1 -dimensional  point 

sets  given  by 

CD  1 

II 

CD 

H- 

CD 

H- 

o 

< 01  < elo  ♦ 21.) 

i = 1,  2,  ...,  I 

(3.4) 

S. 

J 

■ lsjj:  -• 

< SJJ  < *> 

j = 1»  2,  ...,  J 

(3.5) 

and  I and  J are  the  number  of  active  revolute  and  prismatic  joints, 


respectively.  The  end  points  of  each  0 is  considered  to  be  the  same 
point.  Hence,  each  such  interval  is  topologically  a circle. 

Figure  3.1  illustrates  such  a hyperprism,  which  is  a rectangle,  in  the 
active  joint  space  of  a hypothetical  manipulator  with  active  joints 
S22  and  0 . The  subset  of  the  HSC  inside  the  hyperprism  is  also 
illustrated. 

Let  S be  the  set  consisting  of  the  points  of  the  HSC  inside  the 
hyperprism  of  a 6 DOF  manipulator.  The  region  HNS  can  be  covered  by 
mutually  disjoint  regions  (T^'s)  in  many  different  ways;  i.e., 

i=NR 

HNS  = U T with  T,  n T,  = S for  i*j 

i = 1 J 

where  NR  is  the  number  of  regions.  However,  there  is  only  one  way  of 
covering  HNS  while  minimizing  NR.  In  this  case,  every  distinct  region 
Ti  will  be  said  to  correspond  to  a different  configuration  of  the 
manipulator  and  the  number  of  T^s  will  be  called  the  number  of 
configurations  (NC)  of  the  manipulator.  Hence,  instantaneously  the 
robot  will  be  said  to  be  in  configuration  i iff  ^ = [q  , q , .... 

qaA^'  where  qai  » Qa2’  •••*  ^aA  are  active  joint  variables,  is  in  T . 
Clearly  the  naturally  passive  and  passive  joint  variables  cannot 
affect  the  configuration  that  the  manipulator  is  in.  The  regions 
which  are  convex  (those  for  which  any  two  points  within  the  region  can 
be  joined  with  a line  segment  lying  entirely  in  the  region)  will  be 
said  to  correspond  to  the  convex  configurations  of  the  manipulator. 

The  configuration  of  a manipulator  at  any  instant  can  be 
determined  by  examining  the  HSC  in  more  detail.  The  equation  of  the 
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A Hyperprism 
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HSC  is  a polynomial  in  the  variables  s^  ci  (i  = 1,  2 


• • • 9 


I)  and 


Sjj  (j  = 1»  2,  J)  where  I and  J are  the  number  of  active  revolute 

and  prismatic  joints,  respectively.  Here  si  and  c^  are  considered  to 
be  independent  variables.  The  HSC  will  be  said  to  be  reducible  if 
this  polynomial  is  reducible  over  the  field  of  real  numbers. 

Otherwise  it  will  be  said  to  be  irreducible.  Clearly  the 
factorization  is  unique,  up  to  a real  constant,  for  reducible  HSC's. 
Suppose  now  that  the  equation  of  the  HSC  is  reducible  and  can  be 
expressed  as  the  product  of  m factors  (f  's)  raised  to  positive 
integer  powers  (r^s)  such  that 


where  an  f^  is  not  a scalar  multiple  of  an  f and  c is  a real 
number.  Clearly  the  same  HSC  will  be  determined  by  the  simpler 
equation 

° f1  f2  *•*  fm  = 0 (3-7) 

The  points  satisfying  f . = 0 ( i = 1 , 2,  . . . , m)  will  be  said  to  lie  on 
the  i'th  subcomponent  manifold  (HSC  ) of  the  HSC.  It  should  be  noted 
that  if  HSC  separates  a hyperprism  into  two  disjoint  regions,  then 
these  regions  can  be  identified  by  sgn  (f  ).  Here  sgn  denotes  the 
sign  function  which  yields  +1  (-1)  for  a positive  (negative)  argument. 

Equation  (3.7)  can  always  be  rearranged  into  the  form 


r 


(3.6) 


c F.  F 


2 


(3.8) 


where  the  factors  F 's  (i  = 1,  2,  k)  are  groupings  of  the  f.'s 

J 

(j  = 1,  2 m)  in  the  product  form  F * it  f , such  that  the  number 

1 t t 

of  factors,  k,  is  a maximum  with  the  constraint  that  any  joint 
variable  is  contained  in  a single  factor  F only.  For  instance  if 

f1  = 3 2 ’ f2  = C3’  f3  = 3i|  and  f4  = CH  in  e9uation  (3.7),  then 

F1  3 f‘1  = s2>  f2  2 f2  = °3  and  F3  3 f3f4  = S4C4*  The  Points 
satisfying  an  F.  = 0 in  the  active  joint  space  will  be  said  to  lie  on 

the  i'th  component  manifold  (HSC  ) of  the  HSC.  If  F^  does  not 

contain  the  variables  9.,  0,  , ...  and  S..,  S ....  then  HSC. . will  be 

j k dd  ee  ii 

parallel  to  the  axes  0.,  0,  , ...  and  SJJf  S , ...  in  the  joint 

j k dd  ee  J 

space.  However,  the  converse  of  this  statement  is  not  necessarily 
true. 

It  is  sufficient  to  analyze  each  inside  a hyperprism  in  the 

space  of  the  joint  variables  that  F^  contains.  Consider  that  such  an 
analysis  for  each  HSC^  reveals  that  the  number  of  regions,  defined  by 
the  hyperfaces  which  are  orthogonal  to  the  prismatic  joint  variables 
and  the  subset  of  the  HSC^  inside  the  hyperprism,  is  N . It  can  then 
be  concluded  that  the  number  of  conf igurations  of  the  manipulator  is 
given  by 

k 

NC  = ir  N (3.9) 

i-1 

It  should  be  noted  that  if  HSC^  is  the  empty  set,  i.e.,  HSC..  is 
imaginary,  then  » 1 . 

The  first  step  in  the  investigation  of  an  HSC  is  the 
determination  of  the  component  manifolds.  This  will  facilitate  the 
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computation  of  NC  and  the  identification  of  the  configurations.  Then 
each  component  manifold  which  contains  at  most  3 joint  variables  can 
be  plotted  independently.  All  types  of  6 DOF  manipulators  with  A <_  3 
have  HSC's  that  are  visualizable  in  3D  space  even  if  the  HSC  consists 
of  a single  component.  It  should  be  recalled  that  A < 3 for 

(i)  Manipulators  with  N <_  5. 

(ii)  All  6 DOF  group  3 manipulators  (see  Table  3.1). 

(iii)  PPRRRR  and  RRRRPP  manipulators  (see  Table  3.1)  regardless 
of  their  dimensions. 

For  the  remaining  manipulators  which  do  not  fall  into  these  3 
categories  the  visualization  of  the  HSC  is  extensively  enhanced  if  (i) 
the  lowest  upper  bound  of  A,  i.e.,  4,  is  not  achieved;  (ii)  the  HSC 
consists  of  at  least  2 components  due  to  the  dimensions  of  the 
robot.  Almost  all  industrial  manipulators  satisfy  at  least  one  of 
these  conditions. 

Clearly  the  most  difficult  case  occurs  when  A = 4 and  the  HSC 
consists  of  a single  component.  Here  it  is  necessary  to  investigate 
the  q&1  qa2  q^-slices  at  a sequence  of  values  of  q^  within  a 
hyperprism  where  q ^ can  be  any  one  of  the  active  joint  variables. 

3.3  Some  Applications 

Before  presenting  applications  of  the  new  concepts,  some 
definitions  will  be  introduced. 

The  degree  of  a manipulator,  DEG  (DEG  ),  will  be  defined  as  the 
maximum  number  of  real  solution  sets  obtained  from  the  reverse 


displacement  analysis  without  (with)  joint  limitations.  Further  the 
region  CO  (in  the  joint  space)  corresponding  to  the  i'th 
configuration  of  the  manipulator  is  defined  to  be  the  cartesian 
product  of  the  point  sets  , Q2>  and  T.  where  p is  the  number 

of  naturally  passive  and  passive  joints  and 

{q^  -»  < q^^  < ®}  if  q.  is  a P joint 


Ui:  qlQ  < Qi  < (q.Q  + 2ir) } if  q is  an  R joint 

Due  to  the  joint  limitations,  however,  only  certain  subregions  of  the 
CCX’s  will  be  reachable.  Each  such  subregion  will  be  called  a 
subconfiguration  and  will  be  denoted  by  CO  . Here,  the  subscript  i 
indicates  that  C0„  c CO^  and  j = 1,  2,  ...,  m.  where  nu  is  the  number 
of  disjoint  subregions  of  C0i  under  the  joint  limitations.  The  number 
of  these  subregions  will  be  designated  by  NC  . Hence, 

NC 

NC  = l m 
i=1 

For  most  6 DOF  manipulators  each  CO  , i = 1,  2,  ...,  NC,  maps 
onto  some  region  in  the  position  and  orientation  space  of  the  end 
effector  in  a one-to-one  manner  (see  Section  6.1).  In  this  case  NC 
constitutes  a least  upper  bound  (l.u.b.)  for  the  degree  of  the 
manipulator  and  distinct,  real  solutions  obtained  from  the  reverse 
displacement  analysis  always  belong  to  different  configurations. 
Similarly,  NC^  acts  as  an  l.u.b.  for  DEG^.  In  general,  these  two 
l.u.b.'s  will  be  achieved  if  all  of  the  CO.'s  (or  CO  ,'s)  share  a 

A AJ 

common  k-manifold,  with  k <_  N-1 , as  part  of  their  boundaries.  Hence, 


it  follows  that  the  concepts  of  HSC,  configurations  and  subconfigura- 
tions can  be  conveniently  used  for  the  synthesis  of  DEG  and  DEG^ 
during  the  kinematic  design  stage.  This  is  illustrated  in  Section 
3.7.1  using  the  MBA  robot. 

A second  application  is  in  trajectory  planning  which  is  an 
important  stage  in  controlling  a robot.  In  this  stage,  the  desired 
cartesian  space  motion  of  the  manipulator  is  usually  converted  into  a 
curve  in  the  joint  space  which  is  the  most  convenient  space  to  control 
the  manipulator.  A well  known  algorithm  implementing  this  idea  is  due 
to  Taylor  (1979).  In  this  algorithm  the  knot  points  in  the  cartesian 
space  are  converted  into  knot  points  in  the  joint  space  which  are  then 
connected  by  line  segments.  The  method  performs  well  as  long  as 
special  configurations  are  avoided.  It  is  clear  that  depending  on  the 
prescribed  motion  and  the  geometry  of  the  manipulator  it  may  or  may 
not  be  possible  to  execute  the  motion  without  going  through  any 
special  configurations.  This  can  be  easily  verified  using  the  concept 
of  configurations  presented  in  Section  3.2. 

It  is  clear  that  during  a specified  motion  the  robot  does  not 
pass  through  any  special  configuration  if  and  only  if  it  stays  within 
the  same  configuration.  If  the  joint  space  curve  consists  of 
connected  line  segments,  as  in  Taylor's  algorithm  for  instance,  and 
the  manipulator  is  in  a convex  configuration,  then  it  is  sufficient  to 
ensure  that  the  knot  points  belong  to  the  same  configuration.  The 
nonconvex  regions  in  the  active  joint  space  corresponding  to  the 
nonconvex  configurations  can  always^ be  partitioned  into  the  union  of  a 
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finite  number  of  convex  regions.  This  partitioning  is  not  unique  and 
it  can  be  performed  in  such  a way  that  it  yields  the  simplest  criteria 
for  a point  to  lie  in  one  of  these  regions. 

In  general,  the  reverse  displacement  mapping  is  a multi-valued 
function.  Therefore,  there  will  exist  a number  of  joint  space  curves 
corresponding  to  the  same  prescribed  motion.  The  number  of 
intersections  of  each  of  these  curves  with  the  HSC  will  yield  the 
corresponding  number  of  special  configurations.  The  motion  is  best 
executed  using  the  curve  with  the  minimum  number  of  special 
configurations . 

3.4  A Theorem  for  the  Existence  of  Passive  Joints 

Consider  the  screw  systems  V,  $ } and 

i 1 2 h-1 

V2  = ($h»  $h+i*  •••»  for  an  N DOF  serial  manipulator.  Here 
(i  =*  1,  2,  ...,  N)  denote  the  screws  representing  the  relative 
instantaneous  motions  of  the  links.  Further,  let  be  an  invariant 
screw  system  with  respect  to  finite  displacements  of  the  joints 
h,  h+1 , ...,  N (see  Hunt,  1978,  for  a comprehensive  list  of  invariant 
screw  systems).  Practical  examples  of  such  a system  are  the  screws 
representing  the  relative  motions  of  a number  of  successive  links 
that  are  kinematically  equivalent  to  a spherical,  planar  or 
cylindrical  pair.  The  screws  of  V1  can  be  expressed  (in  the 
coordinate  system  b^)  in  terms  of  the  joint  variables  q^  by 

*1,h  * f1(q2’  q3 qh-1)f  *2,h  = f2(q3’  V qh-1 ) ’ 

and  $,  £ = constant.  On  the  other  hand,  V is  an  invariant 

h-l ,h  2 
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screw  system  by  hypothesis.  Hence,  in  B there  exists  a basis 

h 

(independent  of  the  joint  displacements  q,  , q q ) for  V . 

h h+1  mN  2 

This  basis  will  be  denoted  by  {$'  , $'  . $*  }.  The  base 

n n+ 1 N 

{$.  £,  ...»  can  be  replaced  by  the  base 

h,h  h+1  ,h  N,h 

a 

($'h»  $'h+1»  •••»  in  G^O,  2*  •••»  N)  which  is  the  Gramian  of  the 

a 

screws  1,  2,  N in  the  reference  frame  B.  . Thus  it  can  be  deduced 

n 

a 

that  G (1,  2,  N)  will  be  of  the  form  g (q  , q_,  ....  q,  .) 

n 12  2 3 h-1 

which,  when  equated  to  zero,  gives  a subset  of  the  HSC.  The 

Gramians  G^h,  h+1 N)  or  Gy(h,  h+1 N) 

(Y  = h+1,  h+2 N-1 ) on  the  other  hand,  will  be  of  the  form 

g22^qh+1  ’ qh+2’  *•*’  Qjj-i  ^ (sea  Table  2.1).  Hence  an  equation  of  the 
HSC  will  be  of  the  form 

^g12^2*  q3’  *"’  qh-1  ^^g22^qh+1  ’ qh+2’  ””  qN-1  ^ = 0 (3.10) 

Analogously  it  can  be  proved  that  if  the  screw  system  V1  is  invariant 

with  respect  to  finite  displacements  of  the  joints  1,  2 h,  then 

there  will  exist  an  equation  of  the  HSC  which  is  of  the  form 

^S1 1 (q2 * q3’  qh-1  )^g21  (qh+1  ’ qh+2 ’ qN-1  ^ = 0 (3.11) 

Therefore,  the  following  theorem  can  be  stated. 

Theorem  3.1:  If  the  screw  system  V.  = {$..  $_ $ } 

112  h 

^2  = ^h’  ^h+1  ’ ***’  an  N DGF  man^-Pu-'-ator  *-s  invariant  with 

respect  to  finite  displacements  of  the  joints  1,  2,  ...,  h (h,  h+1, 

...,  N),  then  the  h'th  joint  of  the  manipulator  is  passive. 

Furthermore  the  HSC  consists  of  two  component  manifolds,  HSC^  and 
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HSC22’  f>0P  which  there  exists  equations  of  the  form  g^q^,  q0, 

..  Q 


Vi>  ‘ 0 and  s2(Vr  V2’ 


N~1 


1""2’  '131 
) = 0.  Further  if  the  screws 


°f  V,  (V2)  never  become  dependent,  then  the  component  manifold  HSC^ 
(HSC22)  will  be  imaginary  and  hence  the  joints  2,  3,  h-1 

(h+1,  h+2,  ....  N-1 ) will  also  be  passive. 


It  should  be  noted,  however,  that  if  an  h’th  joint  is  passive  it 

does  not  necessarily  follow  that  either  or  V2  is  invariant.  This 

can  be  demonstrated  by  considering  the  manipulator  shown  in 

Fig.  3.2.  The  dimensions  of  this  robot  are  S = S = S =0. 

22  33  55 

S4H  * °»  a-|2  = a23  = a45  = a34  * 0 and  ^5  * °*  Further  a11  the 

twist  angles,  a^’s,  are  equal  to  ir/2.  The  equation  of  the  HSC  is 

given  by 

= ~a3H  a56  [S2]  C(V(c4)]  = 0 (3*12) 

The  first  3 joints,  which  are  kinematically  equivalent  to  a spherical 

joint,  constitute  an  invariant  screw  system.  Therefore,  Theorem  3.1 

predicts  joint  3 to  be  passive,  which  is  in  agreement  with  equation 

(3.12).  Furthermore  as  the  theorem  predicts  the  HSC  consists  of  the  2 

component  manifolds  given  by  s2  = 0 and  s^c^  = 0.  Joint  5 is  also 

passive.  However,  neither  of  the  screw  systems  = {$  $ ..., 

$c}  or  V = {$  , $^}  are  invariant, 
b 2 5 o 

The  hypothesis  of  Theorem  3.1  is  satisfied  by  many  industrial 
manipulators  indicating  that  A _<  3 and  their  HSC’s  consist  of 
component  manifolds.  Hence  their  HSCs  are  simple  to  analyze  and 
visualize,  facilitating  the  determination  of  NC  and  the  identification 
of  these  configurations.  For  instance,  many  industrial  robots  have 
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Fig.  3.2  Manipulator  Used  as  a Counter  Example 
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so-called  "spherical  wrists,"  where  the  last  3 revolute  joint  axes 
cointersect  constituting  an  invariant  screw  system.  Consequently  the 
fourth  joint  is  always  passive  for  this  class  of  manipulators.  Another 
popular  design  is  to  have  3 successively  perpendicular  prismatic  joints 
as  the  3 initial  joints,  i.e.,  the  so-called  Cartesian  Manipulators.  In 
this  case,  the  screws  , $£  and  constitute  an  invariant  system  and 
they  cannot  become  dependent.  Thus  the  second  and  third  joints  are 
passive  yielding  a very  simple  HSC. 

3.5  Synthesis  for  Passive  Joints 
The  hypothesis  of  Theorem  3.1  is  a sufficient  but  not  necessary 
condition  for  the  existence  of  passive  joints  in  a manipulator.  In 
this  section  a synthesis  procedure  for  passive  joints  is  presented. 

Let  £ and  d_  designate  the  vectors  of  specified  and  unspecified 
dimensions  of  an  N DOF  manipulator.  The  following  algorithm  can  be 
used  to  determine  _d  such  that  joint  j is  passive. 

(i)  Find  an  equation  of  the  HSC  using  equation  (2.27). 

(ii)  Transform  all  terms  of  the  form  (sin0)m  or  (cos0)m  into  the 
powers  of  sines  and  cosines  in  terms  of  multiple  angles 
using  standard  trigonometrical  identities.  Here  m _>  2 and 
0 denotes  an  angular  joint  variable.  This  process  ensures 
that  no  feasible  solutions  for  £ are  omitted. 

(iii)  Express  the  resulting  equation  in  the  form 

I D (d)  • Q (£)  - 0 
i 1 

where  Q^q)  * Qh(q)  for  1 * h- 
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(iv)  Equate  the  coefficient  of  each  Q^q)  that  contains  q^  to 
zero. 

(v)  Solve  the  resulting  system  of  equations  for  d_.  Reject 
trivial  solutions,  i.e.,  solutions  which  satisfy  the 
equation  of  the  HSC  identically. 

The  synthesis  procedure  is  now  illustrated  using  a 6R  manipulator 

with  p - [a23  S33  S4J|  ct23  a45  =[0  0 0 901  90  90  90]T.  The 

design  variables  are  given  by  the  vector  d s [a,„  a„)t  alir.  a^,  S„^ 

~ 1 2 3”  "5  5b  22  55 

T 

a.j2]  . The  details  of  steps  (i)  - (iv)  are  omitted  because  of  space 
limitations  and  the  solutions  of  _d  for  the  second  joint  to  be  passive 
can  be  expressed  in  the  form 

d,1  = [x0xx0x±  90  ]T  ~ [x  x 0 0 0 0 ± 90]T 

» [x  0 0 x x x x]T  d;,  = [0  0 x x 0 x x]T 

d5  = [0  x x x x x (0  V 180)]T  dg  = [0  x 0 0 0 0 x]T 

where  the  design  variables  denoted  by  x are  unconstrained.  The 
nontrivial  solutions  are  d^  (see  Fig.  3.3)  and  d22  yielding 

ai2  aH5  [S3]  [a56  Gl»  + ak5  °4  °5  + S55  S4  °5]  = 0 

and 

2 

ai2  a34  t(s  ) (c,) ] [s  ] = 0 


^ In  Sections  3.5  and  3.6  all  angles  are  measured  in  degrees  unless 
otherwise  specified. 

2 

The  solutions  d - d are  trivial  and  satisfy  the  equation  of  the 
HSC  identically.  “6 
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Manipulator  with  a Passive  Second  Joint 


as  the  equations  of  their  respective  HSC's.  The  synthesis  procedure 
for  the  third,  fourth  and  fifth  joints  yields  the  nontrival  solutions 
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dy  » [0  x x x 0 x x]T 


dj  = [x  x 0 0 x 0 x]T 


d^  = [0  x 0 x 0 0 x]T 


respectively,  which  in  turn  yield  the  HSC  equations 


c2  c3)]  [s5^  = 0 


and 


2 


[s2]  C(s4)(c4)]  = 0 


a34  a56  S12 


In  these  equations  the  component  and  subcomponent  manifolds  are 
indicated  with  brackets  and  parentheses,  respectively.  The  example 
presented  here  and  other  examples  indicate  that  when  a manipulator  is 
synthesized  for  a passive  joint  there  will  be  more  than  one  component 
and/or  subcomponent  manifold.  This  facilitates  the  analysis  of  the 
HSC. 

In  the  selection  of  the  prespecified  dimensions,  it  is  useful  to 
refer  to  Table  3-1  • If  the  vector  p.  is  selected  such  that  the  degrees 
of  the  HSC  in  the  remaining  variables  are  low,  the  solution  of  the 
system  of  equations  obtained  at  the  fourth  step  of  the  algorithm  can 
be  considerably  simplified.  Assignment  of  special  dimensions  to  the 
components  of  jp  (such  as  0,  ±90,  180  for  the  angular  ones  and  0 for 
the  linear  ones)  will  simplify  the  system  of  equations  even  further. 
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3.6  Examples 

3.6.1  Manipulators  with  6 Degrees  of  Freedom 

The  first  industrial  robot  to  be  examined  is  the  MBA,  which  is 
illustrated  in  Fig.  3.4.  The  dimensions  of  this  robot  are 


S22 

= 0 

S„„  = 0 
33 

S44 

= 25" 

S55  = ° 

ai2 

= 5" 

a = 22"  a.., 

23  31* 

= 0 

a45  = ° 

a56  ‘ 0 

ai2 

= 90 

“23  ' ° 

a34 

= 90 

“45  = ~9° 

“56  ‘ 90 

The  Jacobian 

[Jn]  = [J,] 

op  3 

can  be  expressed  in 

the  form 

(s 

2+3 

) 

(0) 

(0) 

(0) 

(“V 

<V5> 

(c 

2+3 

) 

(0) 

(0) 

(-1) 

(0) 

(-c5) 

1 — 1 
Ch 
UJ 

1 i 

( 

0 

) 

(1) 

(1) 

(0) 

(o4) 

(3lt35) 

( 

0 

) 

(a23S3) 

(0) 

(0) 

^ ~^44gJ4^ 

(-S4«3«35 

( 

0 

) 

(a23C3) 

(0) 

(0) 

(0) 

(0) 

(- 

ai2‘ 

a„C„) 
23  2 

(0) 

(0) 

-(0) 

("S44S4) 

(S44c1I35> 

which  yields 

the 

equation  of  the  HSC, 

m - 

a23 

S44  ^(c3 

) (a  + a c + 
12  23  2 

S443 

2+3)]  ^®5^ 

3 

550 

C(o  ) (5 

+ 22c2  + 

25s„  „ 
2+3 

)]  Cs5] 

3 550  C(f 1 ) (f2)]  [f  ] = 550  [F1 ] [F2]  = 0 


(3.13) 
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Fig.  3.^  The  MB  Associates  (MBA)  Robot 
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where  = sin(02  + 0^)  and  c^^  = cos(02  + 0^) . Since  the  screw 

system  = {$^f  $ $g}  is  an  invariant  one,  joint  4 is  passive  as 

predicted  by  Theorem  3.1.  Hence  the  HSC,  which  consists  of  3 

subcomponent  manifolds  and  2 component  manifolds,  becomes  a 2-manifold 

in  the  active  joint  space  0 0 0 . The  00  slices  of  this  surface  are 

£ 5 b 2 5 

shown  in  Fig.  3.5.  Essentially  it  consists  of  4 planes  and 

cylindrical  type  surface  parallel  to  the  0_  axis.  The  planes  0 = 90 

5 3 

and  0^  = 270  belong  to  HSC1 , for  which  the  points  A,  B and  W in 
Fig.  3.4  will  lie  on  a straight  line.  The  remaining  two  planes 
0^  = 0 and  0 = 180,  which  indicate  that  joints  4 and  6 are  aligned, 
belong  to  HSC^.  Finally  the  cylindrical  type  surface  is  obtained  by 
equating  f to  zero  and  represents  the  condition  for  the  spherical 
wrist,  W,  to  lie  on  the  first  joint  axis.  Clearly  the  number  of 
regions  defined  by  HSC^  and  HSC22  inside  the  hyperprisms  { ( 0^ , 9^): 

02o  1 02  - 92o  + 360>  03o  1 03  £ 93o  + 360}  and  {V  05o  1 05 
£ 9^q  + 360}  are  4 and  2,  respectively.  Therefore,  the  number  of 

configurations  of  the  MBA  robot  is  NC  = (4)  x (2)  = 8.  Furthermore, 
these  configurations  can  be  identified  by  3”dimensional  row  vectors  of 
the  form  [sgn  f 1 , sgn  f2>  sgn  f^]  where  f 1 , fg  and  f are  defined  in 
equation  (3*13)  • It  should  be  noted  that  4 of  the  8 conf igurations 
namely,  [-1,  -1,  -1],  [-1,  -1,  +1],  [1,  -1,  -1]  and  [1,  -1,  +1] 
are  convex. 

The  actual  dimensions  of  the  MBA  robot  yield  DEG  = NC  = 8. 

Suppose  now  that  it  is  required  to  reduce  the  degree  of  the  manipu- 
lator by  modifying  the  linear  dimensions.  From  equation  (3.13)  it  is 
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(Deg..) 


4 


2:[-l,-l#-l] 

3 : [1/ 1, -1]  4 : [ 1 , -1 , -i ] 


a)  0^2  Slice  at  =•  -150° 


Fig.  3.5  The  HSC  of  the  MBA  Robot 
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(Deg . ) 


f 


3 


= 0 


6 


2 


( Deg . ) 


(b)  90  Slice  at  9.  - -85° 

3 


fig.  3.5 — continued 
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clear  that  HSC^  and  HSC^  cannot  be  made  imaginary.  However,  the  sub- 
component manifold  HSC2  becomes  imaginary  iff  | a^  ^ | > | ^23  I + I S4^ I * 
Satisfying  this  condition  reduces  both  the  NC  and  the  DEG  to  4 . It  is 
possible  to  modify  the  angular  dimensions  also.  However,  it  would 
then  be  necessary  to  leave  them  as  variables  in  the  expression  for 
|J|. 

The  minimal  equation  of  HSC-5  for  the  MBA  robot  is  given  by 
g|( 1 ,2, 3,^ ,5)  + G2(1,2,3,4,6)  + G2 (1,2, 3, 5, 6) 

+ gJ(1 ,2, 4, 5, 6)  + G2(  1 ,3, 4,5 ,6)  + G2(2, 3, 4 ,5 ,6)  = 0 (3.14) 

which,  using  Theorem  2.1  with  E = {3},  is  equivalent  to 

03(1,2,3,4,5)  + 03(1,2,3,4,6)  + 03(1,2,3,5,6) 

+ gJ(1,3,4,5,6)  + G2 (2, 3, 4,5,6)  = 0 (3.15) 

The  determination  of  the  HSC-5  is  substantially  simplified  by 
recalling  that  HSC-5  C HSC-6  and  HSC-6  = HSC1  U HSC2  U HSC^. 

Therefore,  (3.15)  reduces  to  the  equivalent  equations 

[(1109  + 1100s3)  c2  + (220  + 25OS3)  c2  + 25]2 
r 4 4 4 4 4 4n 

x [s4  + c4  s5  + 3 4 c5  + a5]  - 0 (3.16) 

and 

2 2 2 2 p 

C3  C4  S2+3  + S4  ("550s2+3  " 484c2  " 110) 

+ (c  c4)2  (-12100c2  - 2750) 2 = 0 


(3.17) 
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on  HSC1  (given  by  = 0)  and  HSC^  (given  by  f = 0) , 
respectively.1  The  solutions  of  equations  (3.16)  and  (3.17)  are 


t_i  = [(96.1  V 263.9)  90  x x]T  (3.18) 

t_2  = [x  (90  V 270)  (0  V 180)  (0  V 180)]T  (3.19) 

and 

t3  = [103.1  (76.9  V 256.9)  x (0  V 180)]T  (3.20) 

= [256.9  (103.1  V 283.1  ) x (0  V 1 80 ) ]T  (3.21) 

-5  “ Cy2  y3  (9°  v 270)  (0  v 180)]T  (3.22) 


where  (y^,  y^)  denote  the  (9^,  0^)  coordinates  of  any  point  of  HSC^ 
and  tj.  = [02,  0 , 0^,  0 ] . Hence  all  points  on  HSC-5  are  determined 
by  ^1 » ^2 * •••»  ^5 • At  the  outset  it  might  have  been  expected  that 
joint  4 should  be  passive  of  order  5 also  and  that  the  HSC-5  consists 
solely  of  all  the  geometrically  singular  points  of  HSC-6,  i.e.,  points 
where  the  surface  intersects  itself.  However,  this  example  clearly 
shows  that  this  is  not  the  case.  It  should  also  be  noted  that  when 
q e HSC  \ HSC-5  the  manipulator  has  exactly  5 degrees  of  freedom. 

Consider  now  the  T3-776  industrial  manipulator  which  has  the 
dimensions 


The  solution  of  (3.15)  on  HSC  does  not  introduce  any  new  solution 
sets.  2 


1 
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S22  " 

0 

S33-° 

S44  " 55" 

S55 

= 0 

ai2  " 

0 

a = 44" 
23 

a34  " 0 

345 

= 0 

a56  = 

“12  = 

90 

“23  -° 

“34  = 90 

“45 

= 61 

“56  = 

and  is  illustrated  schematically  in  Fig.  3.6.  The  equation  of  the  HSC 
is 


lJl  ■ -°-765  a23  S44  [<03’  U23  °2  * S44  W3  Cs5] 

= -1851.3  C(c3)  (44c,,  + 55s2+3)]  [s  ] 

- -1851.3  C(f'1 ) (f2)]  [f3]  - [F1  ] [F2]  = 0 (3.23) 

which  consists  of  4 planes  and  a surface,  f = 0,  which  is  parallel  to 
the  0^-axis  (see  Fig.  3.7).  The  manipulator  has  8 nonconvex 
configurations  which  can  be  identified  by  row  vectors  of  the  form 
[sgn  fl , sgn  f2,  sgn  f ]. 

The  third  manipulator  to  be  investigated  is  the  Stanford 
manipulator  which  is  of  the  type  RRPRRR  (see  Fig.  3.8).  The  specified 
dimensions  of  the  robot  are 


44  = 0 

S55 

= 0 

12  = a23 

' a34  ' 

345  = 

a56  ’ 0 

10  - 270 

= 90 

ct  , 

1 2 

23 

34 

45 


56 


yielding 
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The  T3-776  Robot 
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1:[1,1,1]  2 : [ 1 , -1 , 1] 


4 : [ -1 , 1 , 1 ] 


Fig.  3.7 


The  0203  Slice  of  the  HSC  of  the  T3-776  Robot  at  0 ^ = 30° 


Fig.  3.8 


Stanford  Manipulator 
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|j|  - [a2i  cs|3:  [s5: 

Hence  the  HSC  is  given  by 


(3.24) 


[s2l  [S33]  [s5]  = [F^  [F2]  [F  ] = 0 


(3.25) 


and  consists  of  3 component  manifolds  resulting  in  8 convex 
configurations  which  can  be  identified  by  row  vectors  of  the  form 
[sgn  F^ , sgn  F^,  sgn  F ].  Clearly  the  fourth  joint  and  the  dimensions 

S22’  9 3 are  Pa33ive* 

The  last  example  is  a 6R  manipulator  with  A = 4 and  with  the 
second,  third  and  fourth  joints  parallel.  The  specified  dimensions  of 
the  robot  are 


ai2  = a56  = S22  = S33  = S44  = ° 


“12  " 90 


“23  = “34  = ° 


“45  = 90 


“56  = 90 


yielding  the  equation  of  the  HSC  as 


a23  a34  C(33)  (a23  °2  + a34  °2+3  + 345  °2+3  °4  + S55  °2+3  S4 


a45  S2+3  34  + S55  S2+3  °4)]  CS5]  3 323  &34  C(V  (f2)]  [f3] 


3 CF^  [F2]  - 0 


(3.26) 


The  first  component  manifold  always  yields  4 regions  in  the  Q^Q 
space  regardless  of  any  geometrical  singularities  that  may  exist  due 
to  special  dimensions.  Hence  the  manipulator  has  8 configurations 
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which  can  be  identified  by  row  vectors  of  the  form  [sgn  f 
sgn  f ]. 


sgn  f , 


All  of  the  manipulators  investigated  in  this  section  have  the 
property  that  each  region  C0^  is  mapped  onto  some  region  in  the 
position  and  orientation  space  in  a one-to-one  manner.  Furthermore, 
the  degrees  of  the  manipulators  are  equal  to  their  respective  number 
of  configurations,  NC's,  in  each  case. 

3.6.2  Manipulators  with  5 Degrees  of  Freedom 

Consider  the  5 DOF  manipulator  which  consists  of  the  first  5 
links  of  the  MBA  robot.  The  minimal  equation  of  the  HSC  is 


[55°s2+3  c3  Cj4]2  + [22s3  s4  (5  + 22c2  + 25s2+3)]2 
+ C22c3  3h  (5  + 22c2  + 25s2+3)]2  + [550c3  c4  (5  + 22c2)]2  = 0 

(3.27) 

all  solutions  of  which  are  given  by  the  first  three  components  of 
t.  (i  - 1,  2,  ...,  5)  in  equations  (3.18)  - (3.22).  The  HSC  consists 
of  6 straight  line  segments,  parallel  to  the  04-axis,  due  to  the 
solutions  t1 , t^,  t4;  2 closed  curves,  on  the  04  = 90  and  04  = 270 
planes,  due  to  t^;  and  4 line  segments,  parallel  to  the  02~axis,  due 
to  It  should  be  noted  that  the  HSC  consists  of  3 disjoint  curves 

in  the  020394  space. 


CHAPTER  4 

MEASURES  FOR  THE  POSITION  AND 
ORIENTATION  SPACE  OF  THE  END  EFFECTOR 

In  this  chapter  two  alternative  measures  are  introduced  for  the 
position  and  orientation  space  of  the  end  effector.  These  measures 
are  shown  to  be  equivalent  for  the  spherical  wrist  manipulators.  Some 
applications  are  also  presented. 

4 . 1 Hand  Freedom  Numbers 

Consider  a 6-dimensional  region  D (in  the  joint  space  of  a 6 DOF 
manipulator)  such  that  the  forward  displacement  mapping  is  one-to-one 
when  restricted  to  D and  |j|  does  not  change  its  sign  on  D.  The  Hand 
Freedom  Number  (HFN)  corresponding  to  the  region  D will  be  defined  as 

HFN(D)  = //////  Abs  ( | J | ) d V (4.1) 

D q 

where  dV^  is  the  differential  hypervolume  element  of  the  joint  space 
and  Abs  (...)  denotes  the  absolute  value  function.  This  number,  which 
has  the  dimension  (length)^,  gives  a quantitative  measure  of  the  total 
freedom  of  the  end  effector  (considered  as  a rigid  body  in  3-space) 
when  restricted  to  D.  In  other  words,  it  induces  a measure  on 

the  Position  and  Orientation  of  the  Hand  (POH)  space. 

The  regions  CO^s,  corresponding  to  the  different  configurations 
of  the  manipulator,  and  CO^'3  satisfy  the  requirements  of  D for  most 
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industrial  manipulators  (see  Section  6.1).  Suppose  now  that 
HFN(C0  ) is  to  be  found  using  definition  (4.1).  It  is  necessary  to 
determine  the  limits  of  the  integrals  which  depend  on  the  boundaries 
of  CO^.  Clearly,  the  hypersurfaces  bounding  any  CO...  have  to  be  of 
the  following  two  types: 


(i)  A hyperplane  orthogonal  to  a joint  variable  axis. 

(ii)  A subset  of  the  HSC. 

Boundaries  of  the  type  (ii)  can  be  difficult  to  handle  if  A = 4 and 
the  HSC  consists  of  only  a single  component  manifold.  In  general  it 


can  be  stated  that  the  lower  the  dimension  of  the  active  joint  space 
and/or  the  higher  the  number  of  component  manifolds,  the  easier  it  is 
to  determine  the  HFNtCO^Vs. 

The  cumulative  hand  freedom  numbers  of  a manipulator  with 
unlimited  and  limited  revolute  joint  motions  are  defined  as 

NC 


CHFN  = l HFN(C0  ) 
U i-1  1 


(4.2) 


and 


1 i 

CHFN  = l l HFN (CO  ) (4.3) 

i = 1 j-1  1J 

respectively,  where  NC  and  NC^  are  the  number  of  configurations  and 
subconfigurations.  These  numbers  are  directly  proportional  to  the 
motion  ranges  of  the  passive  and  naturally  passive  joints  regardless 
of  their  upper  and  lower  bounds.  The  motion  range  of  a joint  i is 
defined  as  qlp  - q,u  - Qn  with  ^ < q^. 
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The  naturally  passive  and  passive  dimensions  of  the  manipulator 
can  be  changed  arbitrarily  without  affecting  HFN* 1  (see  Table  3.1  for 
the  passive  dimensions  of  different  types  of  6 DOF  robots  with 
arbitrary  dimensions).  However,  any  one  of  the  HFN's  is  clearly 
dependent  on  the  vector  of  active  linear  dimensions,  1.  Consider  now 
(i)  group  0 manipulators,  (ii)  group  1 and  group  2 manipulators  with 
no  active  P joints  and  (iii)  all  group  3 manipulators.  Further,  let 
the  joint  motion  ranges  of  the  prismatic  joints  in  cases  (ii)  and 
(iii)  be  catenated  to  _1 . Now,  if  HFN'  corresponds  to  1',  and  1*  is 
changed  to  _1"  = cl/  where  c is  a nonzero  positive  real  number  then 

HFN"  = c(3"g)HFN'  (4.4) 

Here  g denotes  the  group  number  (0,  1,  2 or  3)  of  a 6 DOF  manipulator, 
i.e.,  the  number  of  P joints.  Finally,  it  is  useful  to  normalize  HFN 
for  the  (i),  (ii)  and  (iii)  classes  since  it  is  dependent  on  the  size 
of  1.  Hence,  |HFN  )k , HFN  normalized  with  respect  to  the  k’th  norm  of 
1_,  will  be  defined  to  be  that  value  of  HFN  corresponding  to  |l||k  = 1. 

It  should  be  noted  that  HFN(CO^)  is  infinite  for  manipulators 
with  unlimited  prismatic  joints.  Hence,  for  such  manipulators 
HFN(CO^)  will,  by  definition,  refer  to  the  HFN  corresponding  to  the 
configuration  i when  all  the  sliding  joints  are  limited. 


In  this  paragraph  HFN  is  used  to  abbreviate  any  one  of  the  four 
quantities,  HFN (CO  ),  HFN(C044),  CHFN  or  CHFN  . 

i ij  u 1 


4.2  A Second  Measure 


The  definition  of  HFN(D)  is  a very  general  one  and  is  applicable 
to  any  type  of  manipulator.  However,  it  does  not  supply  us  with  a 
physical  feel  for  the  freedom  of  the  end  effector,  and  it  is 
convenient  to  define  another  measure,  M(D) , in  terms  of  a point  and  an 
axis  on  the  end  effector.  This  measure  is  applicable  to  all 
manipulators  that  have  revolute  joints  as  their  final  joints. 


M(D)  = 0gp  ///  R(x,y,z)  dV 


(4.5) 


where  D is  a 6-dimensional  region  in  the  joint  space  (with  0,.  < 0 

61  — 6 

— 3UC*1  that  the  forward  displacement  mapping  is  one-to-one  when 

restricted  to  D;  (x,y,z)  are  the  coordinates  of  the  point  H on  the  end 
effector  (see  Fig.  4.1)  in  some  fixed  cartesian  coordinate  system;  dV 
is  the  differential  volume  element  of  the  xyz  space;  D'  is  the 
collection  of  all  points  in  the  xyz  space  that  can  be  reached  by  H 
when  £ e D;  and  R(x,y,z)  is  a scalar  point  function  which  will  be 
called  the  Orientational  Freedom  Number  at  the  point  (x,y,z).  It 
should  be  noted  that  M(D)  includes  a 3-dimensional  measure  for  the 
orientation  space  whereas  the  solid  angle  proposed  by  Roth  (1976)  is  a 
2-dimensional  measure.  Furthermore,  the  multi-valued  nature  of  the 
reverse  displacement  mapping  is  accounted  for  in  M(D) . 

In  equation  (4.5)  R(x,y,z)  = 0 whenever  (x,y,z)  t D1.  If  the 
point  (x,y,z)  belongs  to  D',  however,  then  R(x,y,z)  is  determined  in 
the  following  manner.  First,  at  the  point  (x,y,z)  H is  connected  to 
the  ground  using  a hypothetical  spherical  joint.  The  directed  line  HP 
(see  Fig.  4.1)  is  considered  to  be  rigidly  connected  to  link  5.  Then 
the  resulting  2 DOF  closed  loop  mechanism  is  given  all  the  possible 
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Fig.  4.1 


The  Point  H and  Axis  HP  on  the  End  Effector 
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motions  with  the  constraint  that  q e D at  all  times.  As  a result  of 
the  totality  of  these  motions,  the  point  P describes  a region,  D",  on 
the  unit  sphere  centered  at  H.  R(x,y,z)  is  defined  to  be  the  area  of 
D",  which  is  designated  by  A(D"). 

Clearly  the  measure  M(D)  is  physically  meaningful,  whereas  HFN(D) 
is  not.  Generally  M(D)  is  difficult  to  compute  in  practice.  However, 
the  computation  of  HFN(D)  is  relatively  simple.  This  raises  the  issue 
of  the  equivalence  of  the  two  measures  which  leads  to  the  following 
theorem. 

Theorem  4.1  : Consider  a 6 DOF  spherical  wrist  (SW)  manipulator.  Let 

D123  ^ % denote  regions  in  the  q^q^q^  space  and  0^0^  space, 

respectively,  such  that  |j|  * 0 for  any  point  in  D or  D.  . Also, 

123  45 

let  D = Di 23  x °45  x °6  where  °6  is  the  interval  06i  < Q6  < 06u  in  the 
0g  space  and  x denotes  the  cartesian  product.  Then 

HFN(D)  = M(D)  = 0 - V(D» ) • R (4.6) 

where  V(D')  is  the  volume  of  D*  and 


R = R(x,y,z)  = Abs  ( //  (s  3_,  s_)  d0„  d0c) 

n bb  5 4 5 

45 


Proof:  The  dimensions  ah_,  a_,  and  are  zero  for  an  SW 

45  5b  55 

manipulator.  Hence  the  Jacobian  [J  ] can  be  expressed  in  the  form 


CV 


M. 


M, 


(4.7) 
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using  Table  2.1.  Here  0 is  the  3 * 3 null  matrix, 


0 

0 

1 


-s 


45 


'45 


(4.8) 


and  M , M2  are  3 * 3 matrices  which  can  be  explicitly  determined  using 
the  same  table  when  the  types  of  the  first  3 joints  are  specified. 

The  matrices  M1  and  are  functions  of  q2>  and  0^.  Utilizing  the 
screw  transformation  matrix  (see  Section  2.2) 


[f$4]  = 


(4.9) 


the  Jacobian  [Jf]  can  be  defined  as 


[Jf]  s Cf$4]  [J4]  = 


M. 


R4  M3 


(4.10) 


f 

where  is  the  3 x 3 rotation  matrix  converting  the  coordinates  of  a 
vector  in  the  fourth  system  to  the  coordinates  in  the  f’th  system, 

f* 

which  is  a fixed  one.  Components  of  R.  are  functions  of  Q . 

4 V 

T 

Sp  3 » q2,  q^]  and  the  first  3 link  dimensions.  It  follows  from 
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equation  (4.10)  that  |j|  = |fR4  m2|  • | fR4  M3 | = |fR4  M2|  • |M  |. 
Thus 


HFN(D)  = jjj 


123 


which  simplifies  to 


HFN(D)  - 96p  HI 


m2i 


“O,  dq2  dq3  I I (345  356  V d04  d6; 


123 


45 


(4.11) 


It  is  necessary  to  find  R(x,y,z)  in  order  to  determine  M(D). 

Suppose  the  point  H (which  coincides  with  the  center  of  the  wrist  for 

an  SW  manipulator)  is  connected  to  the  ground  by  a spherical  joint  at 

the  point  (x,y,z).  Then  q , and  hence  the  reference  frame  B , is 

-p  3’ 

fixed.  Let  the  coordinates  of  P (see  Fig.  4.1)  in  be  [l,m,n]T. 

Clearly,  [l,m,n]T  = S,  Thus, 

“0*3 


1 


(4.12) 


which  defines  a mapping  from  the  0.0  3pace  into  the  unit  sphere 

4 5 

centered  at  the  point  (x,y,z).  Therefore, 


R(x,y,z) 


A ( D" ) = //  ^EG-F' 


d0„  d0r 


45 


(4.13) 


where  E,  F and  G are  the  coefficients  of  the  first  fundamental  form  of 
the  surface  (see  for  instance  Taylor  and  Mann,  1983)  given  by 
(4.12).  These  coefficients  are  defined  as 
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E 


F 


G 


,91  ,2  ,9m  v2  ,9n  ,2 

W + W * V 


91  91  9m  9m  9n  9n 
90.  90c  + 90,.  90c  + 90.,  90 

4 0 4 0 4 0 


.91  ,2  ,9m  ,2  ,9n  .2 

(90-}  + ^ + (90-} 

5 5 5 


Expanding  the  right-hand  sides  of  the  equation  set  (■4.12)  and 
utilizing  the  above  definitions, 


E 

F 


s45  + 356  “ 2 345  S56  + 345  S56  35  + 2 345  °45  S56  °56  °5 


3 45  S56  °56  C5  + °45  S56 


56 


Substituting  in  (4.13)  yields 


R(x,y , z)  = Abs  ( / J (s^  s^)  d0^  d0^)  (4.14) 

°45 

Clearly,  R(x,y,z)  is  the  same  for  all  (x,y,z)  e D'.  Hence,  definition 
(4.5)  reduces  to 


M(D)  = 0 • R(x,y,z)  • V(D') 


(4.15) 


where  V(D’)  is  the  volume  of  D' . V(D')  can  be  determined  by 


considering  the  mapping  from  the  q^q,^  3Pace  in4°  the  xyz  space  which 
will  be  symbolically  represented  as 


x = f1 (q1  ,q 
z = f3(q1  ,q 
On  the  other  hand, 


2,q3} 


2,q3) 


from  the  last 


3 


y = f'2(q1  ,q2,q3) 

(4.16) 

rows  of  [J^,]  it  can  be  deduced  that 
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T f 

V = [x  y z]  = [ R^  M^]  ^ where  _V  is  the  translational  velocity  of 

f 

point  H in  the  f'th  reference  frame.  Here  the  product  [ R^  does 

f 

not  depend  on  0^  although  both  and  are  functions  of  0^. 

f 

Hence,  [ R^  M ] must  be  the  Jacobian  matrix  of  the  mapping  given  by 

3 (t  ,r  ,t  ) 

equation  (4.16),  and  3"'('q'  q q ) = | R4  M2 1 . Hence, 

V(D')  = ///  |fR4  M2|  dqi  dq2  dq3  (4.17) 

°1  23 

Substituting  the  equations  (4.17),  (4.14)  into  (4.15)  and  comparing 

the  result  with  (4.11),  it  follows  that  HFN(D)  = M(D)  = 0 • V(D')  • R.- 

or 

■ 

4.3  Lowest  Upper  Bounds  of  the  Hand  Freedom  Numbers 

Suppose  now  that  the  1 norm  is  being  used  in  |HFN(COi)Jk  and  the 

lowest  upper  bounds  of  |HFN(C0^)||  are  required  for  group  0,  1,  2 and 

3 SW  manipulators  with  no  active  P joints.  If  definition  (4.1)  is 

employed  to  formulate  HFN(CO^),  it  is  necessary  to  maximize  a multiple 

integral  (with  a varying  integrand  and  region  of  integration)  with 

respect  to  the  dimensions  of  the  manipulator  subject  to  the  constraint 

Jl 1 1 = 1.  Clearly,  this  optimization  problem  is  extremely  difficult 

to  solve  even  with  numerical  methods.  However,  from  Theorem  4.1 

HFN(C0  ) = 0-  • R • V(CO  ').  Then  it  follows  that  0.  = 2ir, 

i 6r  i 6r  ’ 

oijj,.  =>  cij-g  = ± ir/2,  0^  = 2ir , 0 < 0^  < ir  (or  ir  < 0^  < 2ir)  are  necessary 

and  sufficient  conditions  for  the  product  (Qr  • R)  to  be  a maximum. 

or 

2 

This  yields  (0,  • R)  =»  8tt  . The  original  problem  is  thus  reduced 

br  max 

to  maximizing  V(C0^')  subject  to  Jl^  = 1.  The  solution  of  this 


problem  for  the  manipulators  belonging  to  groups  0,  1,  2 and 
the  following  results. 


Group  0:  Dimensions  of  the  ideal  RRRRRR  manipulator  (see  Fig. 

are 


S22 

= 0 

s33.° 

S44 

= 0 

S55 

= 0 

ai2 

= 0 

a23  - 0.5 

a34 

= 0.5 

345 

= 0 

a56 

°12 

= ir/2 

°23  ' 0 

“34 

= 0 

“45 

= ir/2 

“56 

yielding 

|J|  = 0.125  [(s  ) (c2  + c )]  [s  ] 

lHFN(COi)lrao  3 iHFNCCOj)^  = 32tt3/3  j = 1,  2,  ....  8 

lCHFNulm0  3 SCHFNJi  = 256ir3/3 

Group  1 : Dimensions  of  the  ideal  PRRRRR  manipulator  (see  Fig. 

are 


S22 

= 0 

S33-° 

3,,  ' 0 

s55  = ° 

ai2 

= 0 

a23  - 1/3 

a3«  ‘ 1/3 

a45  “ ° 

a56 

“l  2 

= 0 

“23  ' 0 

“34  ' ° 

“45  = 

“56 

and  S = 1/3,  yielding 
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: yields 
4.2(a)) 

= 0 
= tt/2 

(4.18) 


4.2(b)) 

0 

ir/2 
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|J|  = -0.1  [s3]  [s5]  (4.19) 

|HFN(C01)  |m1  = jHFNCCOj)^  = 32tt3/27  j « 1 , 2,  3,  4 

|CHFNulmi  3 |CHFNu|1  = 128tt3/27 

Group  2:  Dimensions  of  the  ideal  PPRRRR  manipulator  (see  Fig.  4.2(c)) 

are 


o 

n 

c\i 

CD 

S„  - 0 
33 

S4H  ' 0 

S =0 

55 

ai2  ' ° 

a23  ‘ ° 

a34  ' 1/3 

a45  = 0 

a56  = 

“12  ‘ 1/2 

“23  ' ° 

«34  ' 0 

a45  = */2 

a56  = 

and  S11r  = S22r  = 1/3,  yieldin8 

| J | = 0.3  [s3]  [3g]  (4.20) 

lHFN(coi)lm2  3 lHFN(C0j)|1  = 16tt2/27  j = 1 , 2,  3,  4 

SCHFNU  lm2  " ICHFNuli  " 64tt2/27 

Group  3:  Dimensions  of  the  ideal  PPPRRR  manipulator  (see  Fig.  4.2(d)) 

are 


92  = 

ir/2 

= — it/2 

S44 

= 0 

S55  ‘ 0 

ai2 

= 0 

a„  - 0 
23 

a34 

- 0 

a45  ' ° 

a56 

“12 

= — ir/2 

ct^  = ir/2 

a34 

= ir/2 

“45  - V2 

a56 

83 


Fig.  H.2  Ideal  Spherical  Wrist  Manipulators 
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Fig.  4.2 — continued 
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Fig.  H.2 — continued. 
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and  S. 


1 1r 


22r 


33r 


1/3,  yielding 


|j|  * Cs5] 

|HFN(C01)|m3  ■ |HFN(CO  ) - 8it2/27 

lCHFNuIm3  = \CliF\\^  = 16tt2/27 


j = 1,  2 


(4.21  ) 


The  results  (summarized  in  Table  4.1)  indicate  that  the  lowest  upper 
bounds  of  |HFN(COi)|1  and  |CHFN  J 's  for  group  0,  1,  2 and  3 SW 
manipulators  are  in  descending  order. 

The  manipulators  listed  above  yield  the  maximum  possible  value  of 
|HFN(C01 ) | for  all  configurations.  Such  configurations  will  be 
defined  as  ideal  configurations,  i.e.,  the  j'th  configuration  of  a 
group  g SW  manipulator  with  no  active  P joints  is  an  ideal 
configuration  if  |HFN(C0J)|1  = |HFN(C0i ) | . Further  if  all 

configurations  of  a manipulator  are  ideal,  all  passive  linear 
dimensions  are  zero  and  |CHFN^  = |CHFNu|  the  manipulator  will  be 
said  to  be  an  ideal  manipulator.  It  should  be  noted  that  the  group  0 
ideal  manipulator  defined  here  is  essentially  the  same  as  the  optimal 
6R  manipulator  derived  by  Paden  (1985)  using  a differential  geometry 
approach.  Ideal  manipulators  have  the  following  useful  properties: 

(i)  The  reachable  and  dextrous  workspaces  (see  Kumar  and 
Waldron,  1980)  of  the  wrist  are  identical. 

(ii)  There  are  no  holes  or  voids  in  the  workspace  except  for  the 
ideal  group  2 manipulator  (see  Fig.  4.3). 
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Table  4.1  Lowest  Upper  Bounds  of  IHFNCCOJ^  and  ||CHFN  1 1 
for  the  Spherical  Wrist  Manipulators. 


g 

lHFN<coi)lmg 

fCHFN  I 
11  u"mg 

0 

32tt3/3 

256ir3/3 

1 

32tt3/27 

128tt3/27 

2 

16tt2/27 

64tt2/27 

3 

8tt2/27 

1 6tt2/27 
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(c)  Group  2 


(d)  Group  3 


Fig.  4.3  Wrist  Workspaces  of  the  Ideal  Spherical  Wrist  Manipulators 
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(iii)  The  end  effector  has  maximum  cumulative  freedom  per  volume 
of  the  wrist  workspace  (V  ) for  a given  fllj  , i.e.,  the 

u 

supplies  its  end  effector  with  maximum  freedom  while 
occupying  a given  physical  space.  The  group  2 ideal 
manipulator  does  not  have  this  property.  In  fact  the  ratio 
JCHFN^I^/V^  does  not  have  an  upper  bound  for  group  2 SW 
manipulators  with  no  active  P joints. 

(iv)  Special  configurations  are  in  general  restricted  to  the 
outer  wrist  workspace  boundary.  The  locus  of  such 
configurations  for  the  ideal  group  0,  1 and  2 manipulators 
are  the  surface  of  the  unit  sphere  and  the  diameter  which 
is  coincident  with  the  first  joint  axis,  the  central  axis 
and  surface  of  the  cylinder,  and  the  planar  portions  of  the 
outer  wrist  workspace,  respectively  (see  Fig.  4.3). 

Ideal  manipulators  yielding  a prespecified  workspace  volume  can 
be  designed  simply  by  applying  an  appropriate  scale  factor,  c,  to  the 
dimensions  listed  above.  The  hand  freedom  numbers  of  the  resulting 
manipulator  can  be  easily  obtained  using  equation  (4.4).  It  should  be 
noted  that  ideal  manipulators  are  in  general  unique  except  for  the 
attachment  of  the  spherical  wrist  to  the  first  3 links.  For  instance, 
if  the  fourth  joint  axis  of  the  ideal  group  0 manipulator  intersects 
the  third  joint  axis  orthogonally  (rather  than  being  parallel  to  it) 
and  the  fifth  and  sixth  joints  intersect  the  fourth  one  orthogonally 
the  resulting  manipulator  would  still  be  an  ideal  group  0 manipulator. 


L/V„  is  a maximum. 
1 1 W 


Hence  an  ideal  manipulator 


ratio  |CHFN 
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The  concepts  introduced  in  this  chapter  are  useful  in  the 
kinematic  design,  motion  planning,  control  and  performance  evaluation 
of  manipulators  of  all  types.  Some  examples  are  given  below: 

(a)  HFN(CO^ ) , a quantitative  measure  of  the  total  freedom  of  the 
hand  corresponding  to  the  i'th  configuration,  is  a function 
of  the  dimensions  of  the  robot  and  the  prismatic  joint 
limits.  HFN(C0 ) depends  in  addition  on  the  revolute  joint 
limits.  For  good  design  the  joint  limits  should  be  decided 
such  that  the  HFN(CO..)'s  are  in  the  same  order  of 

A J 

magnitude.  Relatively  inefficient  CO  's,  having  low 
HFN(CO^j)'s,  should  either  be  totally  eliminated  or  made  more 
efficient  by  changing  the  joint  limits. 

(b)  Let  _A  and  B_  denote  the  end  points  of  the  specified  path  of 

the  end  effector  in  the  POH  space  during  a motion  planning 
task.  Further,  let  £A1 » £A2  and  £B1 » £g2  be  the  pre-images 
of  A and  B under  the  forward  displacement  mapping,  such 
that  aA1.  S01  e and  ^ 3^  c C0kr  Now,  if 

HFN(CO_)  > HFN(CO^),  then  the  prespecified  motion  of  the 
end  effector  is  more  likely  to  be  feasible  when  the 
manipulator  is  in  the  (ij)’th  subconfiguration. 

(c)  CHFN^  is  a quantitative  measure  of  the  cumulative  freedom  of 
the  end  effector  considered  as  a rigid  body.  Different 
manipulators  can  be  rated  according  to  their  CHFl^'s. 

(d)  CHFN  /CHFN  gives  the  fraction  of  the  CHFN  utilized  under 

i u u 

the  revolute  joint  limitations.  A relatively  small  ratio 
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indicates  that  the  revolute  joint  limits  are  too  tight  and/or 
they  have  been  designed  inefficiently.  In  order  to  utilize  a 
given  size  reachable  hyperprism  (in  the  joint  space)  in  the 
most  efficient  manner,  it  should  be  located  such  that 
Abs( | J | ) is  maximized  inside. 

(e)  |HFNCCOi ) | and  ICHFN^J^  serve  as  quantitative  measures  of 

the  efficiency  of  the  design  of  the  dimensions  concerning  the 
freedom  of  the  hand  corresponding  to  CCh  and  the  totality  of 
the  conf igurations,  respectively.  These  measures  are  not 
dependent  on  the  size  of  _1  and  can  be  normalized  using 
IHFN(C01)  |mg  and  ICHFN^. 

4.4  Example 

The  new  concepts  introduced  in  Section  4.1  will  now  be 

illustrated  using  the  MBA  robot,  which  is  the  first  example  in 

Section  3.6.1.  Firstly,  let  the  regions  CO  , C0„ C0o  correspond 

I 2 o 

to  the  configurations  [1,  -1,  1],  [1,  -1,  -1],  [1,  1,  1],  [1 , 1 -1], 

[_1 , 1.  1],  [~1 , 1,  -1],  [-1,  -1,  1]  and  [-1,  -1,  -1],  respectively. 
The  joint  limits  of  the  active  joints  are  given  by  = ( 3/2 ) it , 

02u  = (79/72)ir,  0^  - -ir/4,  0 = (5/4)ir,  0 = -(2/3)ir  and 

0 =*  (2/3)ir.  Furthermore,  0.  = (17/18)tt,  0„  = (3/2)tt  and 

bu  lr  4r 

9gr  - ( 1 0/9 ) tt  .Then  it  follows  that  each  configuration  has  a single 
subconfiguration  under  the  joint  limitations,  i.e.,  = 1 for 

1 = 1,  2,  ....  8.  Now,  from  equation  (4.1) 
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HFN(CO  ) = HUH  Abs  ( | J | ) d V 
C011 


(4.22) 


Substituting  |j|  from  equation  (3.13)  and  simplifying  by  taking 
advantage  of  the  component  manifolds,  passive  and  naturally  passive 
joints  we  obtain 


HFN(CO„>  - 550  [0lr  96i,  6^]  [I^]  IX  J 


(4.23) 


where 


I„  - "ff  (O  (5  + 22c_  + 25s.  J d0o  d0„ 
23  AgQA  3 22+323 


0.6ir 

x5  = J 35  d0c 
3 0 


and  ABCA  is  the  region  shown  in  Fig.  4.4.  It  should  be  recalled  that 

the  HSC  of  the  MBA  robot  consists  of  2 component  manifolds  involving  2 

and  1 joint  variables,  respectively.  Therefore,  the  sextuple  integral 

in  equation  (4.22)  reduces  to  the  product  of  a double  integral,  I , 

and  a single  one,  I . This  conclusion  is  a general  one  applicable  to 

5 


all  manipulators  having  reducible  HSC's.  The  determination  of  I 


23 


is  tremendously  simplified  if  the  double  integral  is  evaluated  over 
the  region  ABCA' A rather  than  ABCA  (see  Fig.  4.4).  AA'C  is  the 
straight  line  given  by  0^  = (-2.0469804)  + 11.015553,  where  0 2 

and  0^  are  in  radians.  The  error  introduced  by  this  approximation  is 
negligible  for  all  practical  purposes,  because  the  area  of  the  deleted 
region  AA'CA  i3  very  small  and  the  value  of  the  integrand  over  AA'CA 
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270  395  (Deg.) 

Fig.  4.4  Subconfigurations  of  the  MBA  Robot 
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is  close  to  zero.  Now,  substituting  0^,  0^  and  0^  and  carrying  out 
the  integrations,  equation  ( 4 . 23 ) yields  HFN(CO  ) = 388,395  inch3. 
Clearly,  HFN(C021)  = HFNCCO^).  Similarly,  the  hand  freedom  numbers 
of  the  remaining  subconfigurations  are  determined  a3 

HFN(C031)  = HFN(C04i)  = 2,715,200  inch3 

HFN(C0  ) = HFN(C0,  ) = 4,778,715  inch3 
51  0 1 

HFN(C0  ) = HFN(C0o  ) = 190  inch3 
71  ol 

These  results  have  been  obtained  using  the  regions  FC’DEF,  GFEJ'HG  and 
HH'JIH  instead  of  FACDEF , GFEJHG  and  HJIH,  respectively  (see 
Fig.  4.4).  The  equations  of  the  lines  FC' , HJ*  and  HH'J  are 

©3  =*  (-1  .875)02  + 10-1<06526 

03  - (-3.764328)02  + 29.529397 

03  = (-2.437173)02  + 20.502986 

respectively,  where  0^  and  ©3  are  in  radians.  The  HFN’s  of  the 
subconfigurations  CO  and  C0g1  clearly  indicate  that  they  are  very 
inefficient.  Hence,  in  the  design  stage  of  the  robot  they  should  have 
been  either  totally  eliminated  or  made  more  efficient  by  changing  the 
joint  limits  of  0^  and  0^  The  cumulative  hand  freedom  number  of  the 
manipulator,  on  the  other  hand,  is  determined  from  equation  (4.3), 
yielding  CHFN^  = 15,765,000  inch3.  Here  it  should  be  recalled  that  in 
general  the  same  size  reachable  hyperprisms  in  the  joint  space  do  not 
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yield  the  same  CHFN  's.  For  instance  if  the  reachable  region  in  the 
space  is  changed  to  GFEIG  and  FBDEF , respectively,  the 
corresponding  CHFN^s  would  be  9,557,810  and  6,207,190  inch3. 

It  is  easier  to  determine  the  HFNCCO^'s  using  Theorem  4.1: 

HFN(COi)  = 06r  • V(C01»)  • R (i  - 1,  2 8) 

where  Qr  = 2ir  and 
6r 


ir(2ir)  2ir 

J J (345  356  3.)  d9  d©  = 4tt  (i  = 1 , 2,  ....  8) 

0j-=O(tt)  0^=0  4 b 


Thus 

HFN(COi)  = 8-rr2  • V(C0.')  (i  = 1,  2,  ...,  8) 

Further  V(C0i')  = V(abca)  for  i - 3,  4,  5,  6 and  V(C0.')  = V(acda) 
for  i = 1,  2,  7,  8;  where  V(abca)  and  V(acda)  are  the  volumes  of 
revolutions  obtained  by  rotating  the  hatched  areas  abca  and  acda 
around  the  z-axis,  respectively  (see  Fig.  4.5).  Hence, 

HFN(C0.)  = 43,457,056  inch3  (i  = 3,  4,  5,  6) 

HFN(C0i ) = 26,313,058  inch3  (i  = 1,  2,  7,  8) 


and  from  equation  (4.2)  CHFN^  = 279,080,456  inch3. 


The  active  linear  dimensions  of  the  MBA  robot  are  a , a 

12’  23 

and  S42|.  Hence  Ij.^  = |a12|  + |a23|  + |S4J||  = 5 + 22  + 25  - 52 
inches.  Now,  let  1»  = [5  22  25]T,  g = 0,  c = 1/|l»|  - 1/52  and 
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Fig.  4.5  XZ  Slices  of  the  CO'fs  for  the  MBA  Robot 
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HFN'  = CHFNu  in  equation  (4.4).  Thus  |CHFN  | = (1/52)3  and 

(CHFNu)  = (1/52)3  (279,080,456)  = 1985  inch3. 

The  design  efficiency  of  the  MBA  robot  can  be  evaluated  using  the 

following  quantities  which  are  independent  of  the  size  of  1_. 

(i)  The  freedom  corresponding  to  the  j'th  configuration  is 

(lOOt.)  percent  of  the  freedom  corresponding  to  the  ideal 
J 

configuration  where  t^  = |HFN(C0j ) ^ /|HFN(COi) |mQ.  For  the 


MBA  robot  t 


= 0.934. 


t„  = t„ 
2 7 


0.566  and  t. 


S • *5  ’ l6 


(ii)  |CHFNul1/|CHFM„| 


0.75  which  indicates  that  the 


u 'm0 

cumulative  freedom  of  the  end  effector  is  75$  of  the  ideal 
group  0 manipulator. 

(iii)  The  freedom  corresponding  to  the  (jl)'th  subconfiguration 

is  (lOOr  ) percent  of  the  freedom  corresponding  to  the  j'th 

configuration  where  r.  = HFN (CO  ) /HFN ( CO . ) . For  the  MBA 

J j 1 J 


robot,  r.  = r_  - 0.015,  r_  = r„  = 0.062,  r 

12  j 4 b 


rg  = 0.110 


and  r„ 


rg  = 0.722  x 10 


(iv)  CHFN1/CHFNu  = 0.056  which  indicates  that  only  5.6$  of  the 
available  cumulative  freedom  is  used  under  the  joint 


limitations . 


CHAPTER  5 

REVERSE  VELOCITY  ANALYSIS 


In  this  chapter  systematic  and  efficient  methods  are  developed 
for  the  reverse  velocity  analysis.  These  methods  take  advantage  of 
any  special  geometry  that  the  manipulator  may  have.  Furthermore,  they 
can  be  easily  extended  to  the  complete  reverse  velocity  analysis  of 
1 DOF  single  loop  spatial  mechanisms  where  all  of  the  joint  velocities 
are  required. 

5 . 1 Manipulators  with  6 Degrees  of  Freedom 
5.1 .1  Manipulators  Without  Any  Special  Geometry 

Let  B denote  the  reference  frame  attached  to  the  end  effector  of 
a 6 DOF  manipulator  such  that  the  origin  0 is  at  the  tip  of  the  vector 

a 

Sjj  Srj  and  the  coordinate  axes  are  parallel  to  the  axes  of  . Here 

A 

the  x axes  of  the  frames  B^  and  B are  parallel  to  an  imaginary  a^ 

which  can  be  any  convenient  unit  vector  in  the  place  perpendicular  to 

S_i , and  01  is  measured  from  aQ1  to  a^  around  S_^  (see  Fig.  5.1). 

Furthermore  let  [J0] , the  Jacobian  formulated  in  the  reference  frame 

B,  be  the  special  Jacobian  discussed  in  Chapter  2 viz.  [J0]  transforms 

T 

q into  V_  = [iil,  v_]  where  w and  v are  the  angular  velocity  of  the 
end  effector  and  the  translational  velocity  of  the  point  0 on  the  end 
effector.  Further,  the  components  of  both  u>  and  v are  expressed  in 
the  frame  B. 
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100 


Reference  Frame 
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The  Jacobian  [J0]  of  a 6 DOF  manipulator  can  be  determined  using 

any  of  the  Jacobians  [J  ] or  [J  ] (g=1 ,2, . . . ,6)  together  with  an 

® g 

appropriate  screw  transformation  matrix,  i.e., 


[v  ■ [ y[v 


[j0]  = [ $*][jg] 


(5.1 ) 

(5.2) 


where 


[B$J  = 


[BV 


[ R 1[E  ] 
g g 


[0] 


tBV 


(5.3) 


and 


CV 


-1 


-m 


(5.4) 


from  equations  (2.15)  and  (2.17),  respectively.  The  matrices  [ $a] 

O 

and  [Ea]  can  be  obtained  from  (5.3)  and  (5.4)  by  replacing  the 
g 

A B B 

subscript  g with  g.  The  rotation  matrices  [ R ],  [ Ra]  and  the 

g g 

nonzero  components  of  [E  ],  [Ea]  ( g= 1 ,2,... ,6)  can  be  determined  by 

g g 

using  Table  3.3  in  Lipkin  and  Duffy  (1985)  and  elementary  rotation 
matrices.  The  details  are  omitted  here  and  the  results  are  presented 


below. 
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cBv  - 


12. .g 

U,2..g 

X12 

gf..1 

V..1 

"Wfe 

;23..g 

W23..g 

Z23 

k = -(a  . + a^.P^  + a.  P . + ...  + a,_P.  . 
g gh  hi  h ij  hi  67  hi.  .6 


* SiiXh  * Vhl  * •••  *S77Xhi..6> 


Xg  ' -(ahiQh  * alJQhi  * •••  + a'-Q--  ' - S"3 


67  hi.. 6 hh  gh 


* S.  Y * S . .Y  + ...  * S Y ,) 
ii  h JJ  hi  77  hi . .6 


m = -(a..R.  + a..R,  . + ...  + a,_R,  . , + S..  c , 

g hi  h ij  hi  67  hi.. 6 hh  gh 


+ SiiZh  + SjjZhi  + + S77Zhi..6) 


gh  g 
ii  hg 


ii  hg 


fe.  .1 

“Qfe..1 

Rfe 

fe.  .1 

Vfe..1 

"Wfe 

fe.  .2 

"Yfe..2 

Zfe 

^i^hg 

+ + a67P6..hg 

+ Shh 

+ . . . + 

S77R6..hg) 

.U.UU  + 
hi  hg 

+ a67U6..hg  + 

Shh^g 

+ ...  + 

S77W6..hg 

(5.5) 


(5.6) 


(5.7) 


(5.8) 


(5.9) 


(5.10) 


(5.11 ) 
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+ a,„X,  ,,  + S 

67  6..ih  gg 


77  6 . . ih 


(5.12) 


where  g=3, 4 and  defghij  designate  successive  positive  integers  in 
ascending  order.  The  definitions  of  the  P,Q,R,U,V,W,X,Y,Z  terras  in 
equations  (5.5)  - (5.12)  are  given  in  Appendix  A and  a multiply 


efficiently  via  equation  (5.1)  or  (5.2).  This  is  because  the  matrices 

[J  ] and  [J  ] are  complicated  for  g=1,2,5,6  (see  Table  2.3(d)  for  the 
g g 

optimal  coordinate  systems  of  6 DOF  manipulators).  Furthermore  the 
corresponding  screw  transformation  matrices  will  also  be  complicated. 
It  follows  from  equations  (5.1)  and  (5.2)  that 


subscripted  U*  term,  with  ascending  or  descending  subscripts,  is 


defined  as 


(5.13) 


g 

Equations  (5.3)  - (5.12)  yield  the  components  of  [ $ ], 

B B B 

[ $jj],  [ $*]  and  [ $*]  in  closed  form.  The  remaining  screw 

B B B B B 

transformation  matrices  namely,  [ $,],  [ $„] , [ $_],  [ $,],  [ $;], 

1 2 O D 1 

B B B 

C $a] , [ $*],  [ $i],  are  omitted  since  they  do  not  yield  [J  ] 


tv'1  ■ c-V'1  [SV 


(5.14) 


[v''  ■ cv'’  [8V 


(5.15) 


respectively,  where  from  equation  (2.19) 
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cg$B]  = 


[E  ]T  [BR  ]T 
g g 


[0] 


‘V 


(5.16) 


[gV 


‘V 


rr,  ,T  -B,,  nT 
[Ea]  [ Ra] 
g g 


[0] 


rBn  ,T 

[ V 


(5.17) 


Equations  (5.1),  (5.2)  and  (5.14),  (5.15)  can  be  used  to  obtain  [J  ] 

D 

and  [J  ]  *  1 for  any  type  of  6 DOF  manipulator  in  closed  form.  In  order 
B 

to  obtain  [J  ] it  is  necessary  to  invert  a Jacobian  [J  ] or  [J  ], 

B g g 

the  closed  forms  of  which  can  be  readily  obtained  from  Table  2.1 . 

This  inversion  process  can  be  simplified  by  partitioning  an 
appropriate  Jacobian  into  submatrices. 

5.1.2  Manipulators  With  Special  Geometry 

Consider  an  nxn  nonsingular  matrix  T.  Let  T be  partitioned  such 

that 


1 


(5.18) 


where  T^  , T^,  T^  and  T^  are  axa,  axb,  bxa  and  bxb  submatrices, 
respectively  (n=a+b) . It  can  then  be  shown  that 


-1 


(5.19) 
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where 


t 


1 


t 


2 


t 

t 


3 

4 


cr,  - t2t;1t3)'1 


-wi’ 


<Vi 


t;'  - T^T3t2 


(5.20) 

(5.21 ) 

(5.22) 

(5.23) 


Here  .t^.t^t^  are  axa»  a*b,  bxa,  bxb  submatrices,  respectively,  and 

the  matrix  T^-is  nonsingular.  Equations  (5.20)  - (5.23)  simplify 

considerably  if  any  one  of  the  submatrices  or  is  the  null 

matrix.  It  will  next  be  shown  that  for  certain  classes  of 

manipulators  at  least  one  of  the  Jacobians  [J  ],...,  [ J _ ] , [J ] , 

1 o 1 

. can  be  transformed  into  an  equivalent  Jacobian  matrix  which 

6 

can  be  partitioned  such  that  in  equation  (5.18)  is  a 4x2  null 
submatrix. 

The  6 DOF  manipulators  can  be  classified  and  labelled  according 

to  the  geometry  of  the  axes  of  a pair  of  successive  joints  a and  8. 

The  axes  of  these  joints  may  be 

(i)  Intersecting  (a  =0), 

ctp 

(ii)  Parallel  or  antiparallel  (s  =0), 

Otp 

(iii)  Orthogonal  (c  =0), 

Otp 

(iv)  Nonorthogonal  and  skew  (c  *0,  a *0,  s *0) 

aB  aB  aB 

or  a combination  of  these  where  ae{ 1 ,2, . . . ,5 } and  6=a+1 . The  class  of 
a manipulator  will  be  described  by  the  format  xxx-xx  where  the  symbol 
x will  denote  a capital  letter  or  an  integer.  The  first  symbol  in  the 
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format  is  one  of  the  letters  A,  S,  C or  N which  label  the  cases  (i)- 
(iv),  respectively.  The  second  and  third  symbols  are  integers  which 
designate  a and  8.  Finally  the  last  pair  of  symbols  are  either  one  of 
the  letters  R or  P and  denote  the  types  of  the  a'th  and  B'th  joints, 
respectively.  For  example,  if  the  second  and  third  joints  of  a 
manipulator  are  revolute  and  prismatic  joints,  respectively,  and  the 
axes  of  these  joints  are  orthogonal,  then  the  manipulator  will  belong 
to  the  class  C23-RP. 

Consider  now  the  following  special  classes  of  manipulators  and 
the  corresponding  transformed  Jacobians. 

1)  Aag-RR  manipulators: 


[J’H  = [K  ] [K  , ] [J  ] [K  ] 
a 25  36  a c 


(5.24) 


(5.25) 


2)  Sag-RR  manipulators: 


[J*]  = [K  , ] [J  ] [K  ] 
a 36  a c 


(5.26) 


£JS]  " [K36][J8]CKc] 


(5.27) 


3)  Sa8~PR  manipulators: 


(5.28) 


4)  Sa8“RP  manipulators: 


CJ']  = [K  ] [<J  ][K  ] 
a 35  a c 


(5.29) 
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5)  CaB-PR  manipulators: 

[Ji]  - [K25]tJa][Kc] 

' C,t36]Well:Ko] 

6)  CaB-RP  manipulators: 


[J’l  = PC,,][J  ] [K  ] 
a 36  a c 

Up  = CK253[VCKc] 

7)  NaB-PP  manipulators: 

[J* ] = [J  ][K  ] 

a a c 

UP  - ^b]CKc3 

where  a=1,2,...,5;  B=a+1  and 


[K  ] = [K  ,][K  ] 

o B6  a5 


(5.30) 

(5.3D 

(5.32) 

(5.33) 

(5.34) 

(5.35) 

(5.36) 


Here  [K^]  denotes  the  6x6  elementary  transformation  matrix  which  is 
obtained  from  the  identity  matrix  [I,]  by  interchanging  the  i'th  and 

D 

p’th  columns.  If  a 6x6  matrix  [M]  is  premultiplied  (postmultiplied) 
by  CKip]»  the  i'th  and  p’th  rows  (columns)  of  [M]  are  interchanged. 
Clearly,  [K  ] 1 = [K1  ]. 

It  should  be  noted  that  both  the  natural  (i.e.,  unprimed)  and  the 
transformed  (i.e.,  primed)  Jacobians  describe  the  same  linear 
transformation  which  is  from  the  actuator  velocity  space  into  the  hand 
velocity  space.  However,  the  domain  and  range  spaces  are 
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coordinatized  differently.  The  natural  Jacobian  [J  ]([J  ]) 

a a 

T 

transforms  the  actuator  velocity  vector  q = [q  ...q^]  into  the  hand 

T T 

velocity  vector  v = [a  v ] = [u  to  to  v v v] 

J -a  -a  -a  ax  ay  az  ax  ay  az 


A A 


IJI  AAAAAArjl  A 

(V=[(ov]=[to  to  to  v v v]),  where  to  (to  ) and 
-a  -a  -a  ax  ay  az  ax  ay  az  -a  -a 

v (v  ) designate  the  angular  velocity  of  the  end  effector  and  the 

—a  -a 

translational  velocity  of  a point  on  the  end  effector  which  is 

instantaneously  coincident  with  0 (0  ).  Here  both  vectors  are 

a a 

a 

expressed  in  B (B  ) . The  transformed  Jacobians 
a a 


[J’]  = [K  ][J  ] [K  ] 
a r a c 


(5.37) 


and 


[j;]  = [Kr][Ja][Kc]  (5.38) 

on  the  other  hand,  transforms 

£'  = [Kc]_1  q (5.39) 

into 

V’  = [K  ] V (5. MO) 

-a  r -a 

and 

V’  = [K  ] V (5.41) 

-a  rJ  -a 

respectively.  Clearly  all  of  the  transformation  matrices  [K^]  and 

[K  ] in  equations  (5.24)  - (5.35)  are  simple,  orthogonal  matrices, 
c 

They  recoordinatize  the  actuator  and  hand  velocity  spaces  via 
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equations  (5.39)  - (5-^1 ) merely  by  changing  the  order  of  the  base 
vectors. 

The  transformed  Jacobians  given  by  equations  (5.24)  - (5.35)  can 
be  partitioned  as  in  equation  (5.18)  where  a=4  and  b=2.  This  yields 
T =0  for  each  case  and  the  inverses  of  the  transformed  Jacobians  can 
be  obtained  from  (5.20)  - (5.23).  Therefore, 


where  the 
equations 


t = t'1 
C1  1 


t2  = ° 


t3  = -t^y;1 


t = t"1 
1 4 


T^  matrices  for  the  transformed  Jacobians  given  by 
(5.24)  - (5.35)  are 


[t4] 


-1 


c „/s  „ 
aB  aB 


-1  /s 


aB 


[t4] 


-1 


1/s 


aB 


-c  /s  „ 
aB  aB 


[t4] 


-1 


1 /a 


aB 


•1  / (a  c ) 
aB  aB 


(5.42) 

(5.43) 

(5.44) 

(5.45) 


(5.46) 


(5.47) 


(5.48) 
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[T4] 


-1 


1 /(a  DC  ) 
aB  aB 


-1  /a 


aB 


-1 


1 /c 


aB 


CT4] 


L. 


1 /c 


aB 


[t4] 


-1 


-a 


aB 


-1  /s 


aB 


[t4] 


1 / 3 


aB 


nV 


-i 


-1  /s 


aB 


Ct4] 


-1 


1/3 


aB 


aB 


(5.49) 


(5.50) 


(5.51) 


(5.52) 


(5.53) 


(5.54) 


(5.55) 


Ill 


[T4] 


-1 


c /s  _ 
aB  aB 


-1  / 3 


aB 


Ct4] 


-1 


1 /s 


aB 


-c  „/s  „ 
aB  aB 


(5.56) 


(5.57) 


respectively.  Hence  the  inverses  of  the  transformed  Jacobians  given 
by  (5.24)  - (5.35)  can  be  determined  by  inverting  a single  4x4 
submatrix,  T1 , only. 

Suppose  now  that  a 6 DOF  manipulator  belongs  to  one  of  the  7 

special  classes  identified  previously.  The  corresponding  transformed 

Jacobian  will  be  of  the  form  (5.37)  or  (5.38),  say  (5.37)  for 

instance.  The  inverse,  [J']  1 , can  be  effectively  determined  as 

a 

described  in  the  previous  paragraph.  The  inverse  of  the  natural 

Jacobian  [J  ] can  then  be  expressed  as 
a 

[J  l'1  = [K  ][J*]"1CK  ] (5.58) 

a car 

Substituting  (5.58)  into  (5.14)  together  with  g=a, 

[Jj-1  = [J"]'1  [V]  (5.59) 

a a d 

where  [J”]  1 = [K  ] [J']  1 and  [a$’]  = [K  ] [a$  ].  These  matrices 
a c a B r B 

can  simply  be  obtained  by  interchanging  the  appropriate  rows  of 

j 

[J1]"1  and  [a$n]  as  depicted  by  rK  ] and  rK  ] respectively, 
a B c r 
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For  most  industrial  manipulators  the  closed  form  of  [j  ] 

B 

will  be  simple.  Hence  it  will  be  efficient  to  use  [J  ] 1 for  the 

B 

reverse  velocity  analysis.  However,  if  [J  ] 1 is  too  complicated,  the 

matrices  [“$']  and  [J"]  1 in  (5.59)  should  not  be  premultiplied.  In 
B a 

this  case  q can  be  more  efficiently  determined  by  multiplying  the 

given  V with  [ $']  and  [J"]  , respectively. 

— b d a 

Suppose  now  that  a single  dimension  of  a manipulator  is  specified 

such  that  the  manipulator  belongs  to  one  of  the  7 classes  identified 

previously  and  the  corresponding  transformed  Jacobian  is  [J'].  The 

a 

number  of  terms  in  T1 , i.e.,  the  4x4  submatrix  in  the  upper  left-hand 
corner  of  [J^],  will  be  a minimum  if  a is  the  optimal  coordinate 
system  for  the  manipulator  (see  Section  2.2).  The  submatrix  T^  will 
simplify  even  further  if  some  of  the  remaining  dimensions  are  also 
special,  i.e.,  a linear  dimension(s)  is  zero  and/or  an  angular 
dimension(s)  is  a multiple  of  ir/2  or  ir.  Therefore,  it  follows  that, 
if  possible,  the  transformed  Jacobian  corresponding  to  the  optimal 
coordinate  system  is  the  best  one  to  be  used  in  equation  (5.59).  Here 
it  is  useful  to  note  that  a manipulator  can  belong  to  more  than  one 
class  and  for  a given  class  there  may  be  two  alternatives  for  the 
transformed  Jacobian. 

Equations  (5.24)  - (5.35)  can  also  be  used  in  the  kinematic 
design  stage  of  the  manipulator  in  order  to  design  manipulators  with 
efficient  reverse  velocity  analyses.  The  first  step  in  the  design 
process  is  the  determination  of  the  type  of  the  manipulator,  after 
which  the  optimal  coordinate  system(s)  can  be  obtained  from 
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Table  2.3(d).  Suppose  for  example  that  the  a’th  coordinate  system  is 

the  optimal  one.  It  is  always  possible  to  include  the  manipulator 

into  one  of  the  7 classes  such  that  [ J f ] is  the  corresponding 

a 

transformed  Jacobian.  The  design  constraint  necessary  to  achieve  this 
involves  only  a single  dimension  (a  or  a..)  for  which  there  may  be 
several  alternatives.  Hence  this  constraint  is  not  overly  restrictive 
at  all  and  allows  other  design  criterion  to  be  satisfied 
simultaneously. 


5.2  Manipulators  Containing  a Planar  Pair 
Let  the  6 DOF  manipulators  containing  three  successive  joints 
which  are  kinematically  equivalent  to  a planar  (E)  pair  be  classified 
according  to  the  format  E(xxx)-x.  The  symbols  inside  the  parentheses 
are  either  an  R or  a P,  designating  the  types  of  the  joints  (in 
ascending  order)  that  are  equivalent  to  the  planar  pair.  The  last 
symbol  is  an  integer  which  stands  for  the  joint  number  of  the  first  of 
the  joints  simulating  the  E-pair.  For  example,  if  the  third,  fourth, 
and  fifth  joints  of  a manipulator  are  of  the  types  R,  P,  and  P, 
respectively,  and  if  these  kinematic  pairs  are  equivalent  to  an  E- 
pair,  then  the  robot  will  be  said  to  belong  to  the  class  E(RPP)~3. 
There  are  altogether  7 such  classes  which  are  listed  in  Table  5.1 
together  with  the  special  dimensions  of  the  kinematic  chain  equivalent 
to  the  E-pair.  In  this  table  d=1,2,3,4;  e=d+1  and  f=d+2. 

The  last  column  of  Table  5.1  lists  the  transformed  Jacobians 
which  can  be  obtained  from  equations  (5.37)  and  (5.38)  where 
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Table  5.1  Dimensions  and  Transformed  Jacobians  of  the  6 DOF 
Manipulators  Containing  Planar  Pairs. 


Class 

“de 

(Deg.) 

“ef 

(Deg.) 

9e 

( Deg . ) 

Transformed 

Jacobians 

E(RRR) -d 

0 

0 

- 

AAA 

E(PRR)-d 

90 

0 

- 

,ZJp 

E (RPR) -d 

90 

90 

180 

A 

,[3f] 

E (RRP) -d 

0 

90 

- 

,[3;i 

E(RPP)-d 

90 

- 

90 

E(PRP)-d 

90 

90 

- 

wy.w;] 

E(PPR) -d 

- 

90 

90 

a 

[JjJ.EJJ] 
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ct=d,e,f  and 


[K  ] = [K__]  (5.60) 

r 36 

[Kc]  " [Kf6]CKe5]CKdH]  (5‘61) 


Every  transformed  Jacobian  shown  in  this  table  can  be  partitioned  as 
in  equation  (5.18)  where  a=b=3.  This  yields  T^=0  for  each  case  and 
the  inverses  of  the  transformed  Jacobians  can  be  conveniently 
determined  from  (5.42)  - (5.45).  Some  of  the  matrices  for  the 
transformed  Jacobians  are  listed  below. 


E(RRR)-d  manipulators: 


a , a _ 
de  ef 


[T  ]_1 - 

U4Je 


a . a _ 
de  ef 


a _c  /s 
ef  e e 

aef 

a . a _ 
de  ef 

-(a.  +a  _c  )/s 
de  ef  e e 

"aef 

0 

a , /s 
de  e 

0 

0 

a _/s 
ef  e 

0 

0 

-(a.  c +a  _)/s 
de  e ef  e 

ade 

a . a p 
de  ef 

a . c /s 
de  e e 

“ade 

0 

(5.62) 


(5.63) 
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E(PRR)-d  manipulators: 


[T  ]_1  = — 

L 4Je 


ef 


a _/s 
ef  e 


-c  /s 
e e 


c /s 
e e 


0 

1 

•1 


ef 


[T^lf 


1 1 


ef 


a „/s 
ef  e 


-c  /s 
e e 


o /s 
e e 


0 

1 

-1 


0 

0 


ef 


E(RPR)-d  manipulators: 


1/S 


ee 


(a.  -a  »)/S 
de  ef  ee 


■1/S 


ee 


0 

-1 

0 


1 

0 

0 


E(RRP)-d  manipulators: 


[T  ] = — I— 

L 4Jd  a . 

de 


c /s 
e e 


-c  /s 
e e 


aJ  /s 
de  e 


1 

-1 

0 


de 


0 

0 


(5.64) 


(5.65) 


(5.66) 


(5.67) 
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[T  ]_1  = — 
L 4Je 


de 


1 /s 


-1  /s 


aJ  c / 3 
de  e e 


-a 


de 


de 


(5.68) 


E(RPP)-d  manipulators: 


'°ef/3ef 


1 /s 


ef 


0 

-1 

0 


E(PRP)-d  manipulators: 


1 

0 

0 


tVe’ 


1 /s 


0 /s 
e e 


0 

0 

-1 


E(PPR)-d  manipulators: 


0 

1 

0 


(5.69) 


(5.70) 


tVr 


1/S 


de 


-c  . /s  . 
de  de 


0 

1 


0 

0 


(5.71) 


0 


where  [T„]  and  [T„]  (a=d,e,f)  denote  the  3x3  submatrices  in  the 

4 a 4 a 

A 

lower  right-hand  corners  of  [J']  and  [Jf],  respectively.  The 

a a 
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remaining  [T^]  1 matrices,  to  be  used  in  equations  (5.42)  - (5.45)  for 
the  inversion  of  the  transformed  Jacobians  listed  in  Table  5.1,  can  be 
obtained  using  (5.62)  - (5.71)  and  the  following  relations: 


[V;'  - CK,3]  [Ti]d' 


where  ct=d,e,f; 


c 

a 


3 

a 


[V] 

a 


c 

ct 


0 

0 


0 0 1 


(5.72) 

(5.73) 


(5.74) 


[K  ] 

m 


1 

0 

0 


0 0 

-1  0 

0 1 


(5.75) 


and  is  the  3*3  matrix  obtained  by  interchanging  the  subscripts 

de  and  ef  by  ef  and  de,  respectively,  in  the  components  of  [T„]J1. 

4 d 

Hence  the  inverses  of  the  transformed  Jacobians  listed  in  Table  5.1 
can  be  determined  by  inverting  a single  3x3  submatrix,  T , only. 

The  inverse  of  the  base  Jacobian,  [J  ] ^ , can  be  determined  from 

D 

(5.59)  where  [K^]  and  [Kc]  are  given  by  (5.60)  and  (5.61).  Any  of  the 
transformed  Jacobians  shown  in  Table  5.1  can  be  used  in  (5.59). 
However,  it  is  best  to  use  the  Jacobian  [J1  ] which  is  the 
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transformed  Jacobian  with  the  least  number  of  terms  in  the  first  3 
columns.  Its  inverse  can  thus  be  computed  with  a minimum  effort.  The 
transformed  Jacobian  [ J^  can  be  easily  determined  using  equations 

(5.37)  and  (5.38)  and  Tables  2.1  and  2.2  once  the  type  of  the 
manipulator  is  known. 

5.3  Manipulators  Containing  a Spherical  Pair 

Three  successive  revolute  joints,  say  the  d'th,  e'th  and  f’th 

ones,  with  the  property  that  a_,  = a„  = S =0  are  kinematically 

de  ef  ee 

equivalent  to  a spherical  pair.  A manipulator  containing  such  a 
special  3R  chain  will  be  said  to  be  an  S-d  manipulator  ( d= 1 ,2,3,4). 

For  an  S-d  manipulator  consider  the  transformed  Jacobians  [J^],[J^], 

A A 

[J^]  and  [J^.]  which  are  defined  by  (5.37)  and  (5.38)  where 


[KJ  ■ [KlJ[K25][K36] 

(5.76) 

[Kc]  ■ CWV 

(5.77) 

These  Jacobians  can  be  partitioned  as  in  equation  (5.18)  with  a=b=3. 
This  yields  T^O  for  each  case  and  the  inverses  of  the  transformed 
Jacobians  can  be  conveniently  determined  from  (5.42)  - (5.45).  The 

/s 

Jacobian  [J£]([J^])  will  have  the  same  property  if  the  joint  offset 

S--(S..)  is  also  zero  in  addition  to  aJ  ,a  _ and  S . The  T?1 
ff  dd  de’  ef  ee  4 

matrices  for  [J']  and  [J*]  are 
d e 
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[T 


-1  1 


4 d s , s _ 
de  ef 


s _c  / s 
ef  e e 


C 3 3 3 

de  ef  de  ef 


■(s,  c „+c.  3 oC  )/s  -s  - 

de  ef  de  ef  e e ef 


s_,  /s 
de  e 


and 


(5.78) 


CTJ 


-1  1 


4 e 3.3. 

de  ef 


3 „/s 

ef  e 


•(S,  C „G  + C,  3 _)/S  3 . C . 3.3- 

de  ef  e de  ef  e de  ef  de  ef 


s , c /s 
de  e e 


-s 


de 


(5.79) 

* -1  • -i  * -i 

respectively.  The  remaining  inverses,  namely  [T^]^  , [T^]  , [T^] 

~ -1 

and  , can  be  easily  obtained  from  equations  (5.72),  (5.73), 

(5.78)  and  (5.79).  Hence  the  inverses  of  the  transformed  Jacobians 
can  be  determined  by  inverting  a single  3*3  matrix,  , only. 

The  inverse  of  the  base  Jacobian,  [J  ] 1 , can  be  determined  from 
(5.59)  where  [K^]  and  [K  ] are  given  by  (5.76)  and  (5.77).  Analogous 
to  the  manipulators  containing  E-pairs,  it  is  best  to  use  the 
transformed  Jacobian  [J^  ] in  equation  (5.59)  (see  the  last  paragraph 
of  section  5.2  for  the  definition  and  the  determination  of  [J' . ]). 


5.4  Singularities 

The  reverse  velocity  analysis  of  a manipulator  breaks  down 
whenever  the  manipulator  is  in  a special  (or  singular)  configuration, 
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i.e.,  whenever  the  joint  displacement  vector  q_  is  on  the  HSC.  In  this 
section  the  equations  of  the  HSC's  for  two  broad  and  important  classes 
of  manipulators  will  be  listed  in  closed-form.  The  first  class  is  the 
well  known  spherical  wrist  (SW)  manipulators  which  includes  many 
industrial  robots.  The  second  class  is  the  planar  wrist  (PW) 
manipulators  defined  in  the  next  section. 

5.4.1  Planar  Wrist  Manipulators 

Planar  wrist  manipulators  are  analogous  to  their  spherical  wrist 

counterparts  in  many  ways.  As  the  name  implies,  the  last  3 links  of  a 

PW  manipulator  are  kinematically  equivalent  to  a planar  pair.  The 

first  3 joint  freedoms  are  employed  to  locate  the  end  effector  on  a 

specified  plane  P such  that  a._  lies  in  P and  S_  is  parallel  to  the 

~ 67  —7 

unique  normal  assigned  to  P.  The  last  3 joint  freedoms  simply  control 

the  position  and  orientation  of  a,_  in  P.  Therefore,  the  motion  of 

— o7 

the  end  effector  on  a specified  plane  is  decoupled  from  the 
positioning  of  the  end  effector  on  that  plane.  Consider  now  the 
following  properties  of  the  PW  manipulators: 

(i)  The  reverse  displacement  analysis  can  be  easily  and 
efficiently  tackled  in  real  time  (see  section  6.2.2). 

(ii)  The  reverse  velocity  analysis  can  be  reduced  to  the  inversion 
of  a 3x3  submatrix  (see  section  5.2)  and  thus  lends  itself  to 
fast  computation. 

(iii)  The  fourth  joint  of  a PW  manipulator  is  always  passive;  and 
the  HSC,  which  reduces  to  at  most  a 2-manifold  in  the  3- 
dimensional  active  joint  space,  consists  of  two  component 
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manifolds  (see  Theorem  3.1).  Therefore,  the  identification 
of  the  HSC  and  the  configurations  is  enhanced  extensively, 
(iv)  There  are  seven  different  classes  of  PW  manipulators 

(excluding  the  arrangement  of  the  first  three  joints).  These 
classes  are  E(RRR)-4,  E(PRR)-4,  E(RPR)-4,  E(RRP)-4,  E(RPP)-4, 
E(PRP)-4  and  E(PPR)-4  (see  Table  5.1  for  the  corresponding 
dimensions  and  transformed  Jacobians) . This  leads  to 
flexibility  in  the  kinematic  design,  allowing  other  design 
criteria  to  be  satisfied  simultaneously. 

(v)  Many  industrial  tasks  require  a manipulator (s)  to  perform 
operations  on  different  prespecified  planes.  Planar  wrist 
manipulators  are  especially  suitable  for  such  cases  because 
most  of  the  time  it  is  only  necessary  to  control  the  last 
three  joints.  Furthermore,  for  the  PW  manipulators  the 
problems  of  obstacle  avoidance  and  interference  of  two  robots 
operating  in  parallel  can  be  efficiently  tackled  using  the 
algorithms  developed  for  planar  robots  by  Young  (1986). 

It,  therefore,  follows  that  the  PW  manipulators  are  suitable  for  the 
control  and  motion  planning  algorithms  as  much  as  their  SW 
counterparts.  However,  as  a direct  consequence  of  their  kinematic 
designs,  the  PW  manipulators  are  more  suitable  for  tasks  requiring 
planar  motion  whereas  the  SW  manipulators  may  serve  better  for 
handling  and  transportation  purposes. 

It  follows  from  Theorem  3.1  that  the  HSC  of  a PW  manipulator  is 
at  most  a 2-manifold  in  the  3"dimensional  active  joint  space. 
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Furthermore,  the  HSC  consists  of  2 component  manifolds,  namely  HSC^ i 

and  HSC22.  The  second  manifold,  HSC22,  is  dependent  on  the  class  of 

the  PW  manipulator.  The  equation  of  this  manifold  for  the  7 different 

classes  are  listed  in  the  following  table  (Table  5.2).  It  should  be 

noted  that  besides  the  joint  variables,  the  equation  of  the  HSC22’s 

also  contain  the  dimensions  which  have  to  be  nonzero.  Furthermore, 

the  second  component  manifold  consists  of  the  pair  of  planes  0=0, 

5 

0 =ir  for  the  classes  E(RRR)-4,  E(PRR)-4,  E(RRP)-4  and  E(PRP)-4;  the 
5 

plane  S^^=0  for  the  class  E(RPR)-4;  and  the  null  set  for  the  classes 
E(RPP)-4  and  E(PPR)-4. 

The  first  component  manifold  HSC1 ^ , on  the  other  hand,  depends  on 
both  the  class  of  the  manipulator  and  the  types  of  the  first  three 
joints.  The  equation  of  this  manifold  for  the  PW  manipulators  RRRE, 
RPRE , RRPE  and  PRRE  are  listed  below. 

RRRE  Manipulators: 


S34[al2(312323S3433C3  " 31 2S23C23C34S3  ' °1 2323°34C2S3 


' C12323C23334C2S3C3  + °1 2323334S233)  + 323 ( 3 1 2334C2S3°3 
31 2S23C3432G3  + S12C23334S2C3)  + S22(31 2323G34S2S3 


+ 312323°23334S233C3  + 312S23334C2S3)]  = ° 


(5.80) 


RPRE  Manipulators: 


(312S23C23S34C233C3  + 31 232333432°3 
" 31 2C23°34C2S3  + °1 2S23S34S3°3  " 0 


31 2G23C34S2°3 
12S23C23C34S3) 


0 


(5.81) 


Table  5.2  Equations  of  HSC22  for  the  pw 
Manipulators . 


Class 

Equation  of  HSC22 

E(RRR)-4 

a45a5635  ‘ ° 

E(PRR)-4 

a56s5  ' ° 

E (RPR) -4 

s55-o 

E(RRP)-4 

a1535  ‘ ° 

E(RPP)-4 

356  ' 0 

E(PRP)-4 

03 

U1 

II 

O 

E(PPR)-4 

345  ‘ 0 

E(PPR)-4 
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RRPE  Manipulators: 


s c , (s  c . s 
12  34  23  34  2 


(5.82) 


PRRE  Manipulators: 


s s c,c  - s c s,cc 
12  23  34  2 12  23  34  23 


(5.83) 


The  remaining  possible  types  of  PW  manipulators  PPPE,  RPPE,  PRPE  and 
PPRE  are  not  considered  here  because  they  cannot  supply  the  end 
effector  with  the  full  6 degrees  of  freedom,  i.e.,  |j|  for  each  of 
these  manipulators  vanishes  identically. 

The  first  component  manifold,  HSC1 1 , can  be  determined  using 
equations  (5.80)  - (5.83)  if  the  PW  manipulator  belongs  to  either  one 
of  the  classes  E(RRR)-4,  E(RPR)-4,  E(RRP)-4  or  E(RPP)-4.  Furthermore, 
the  closed-form  of  Abs(|j|)  can  be  obtained  by  multiplying  one  of  the 
expressions  on  the  left-hand  sides  of  these  equations  with  one  of  the 
expressions  on  the  left-hand  sides  of  the  equations  given  in  the 
second  column  of  Table  5.2.  Here  the  expressions  to  be  used  depend  on 
the  types  of  the  first  3 joints  and  the  class  of  the  PW  manipulator. 

For  the  PW  manipulators  that  belong  to  the  classes  E(PRR)-4, 
E(PRP)-4  or  E(PPR)-4  the  equations  that  are  analogous  to  (5.80)  - 

(5.83)  (i.e.,  the  equations  obtained  from  |j|)  are  excessively 
complicated  and  will  not  be  listed  here.  Instead,  equations  (5.80)  - 

(5.83)  will  be  modified  so  that  they  yield  the  points  on  HSC^  for  the 
aforementioned  classes  of  manipulators.  Firstly  it  is  noted  that  the 
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points  on  HSC-,  •,  given  by  equations  (5.80)  - (5.83)  are  the  singular 

points  of  the  transformation  representing  the  positioning  of  the  wrist 

3(P. .P?,P J 

plane  (see  Section  6.2.2),  i.e.,  -r-. - — = 0 is  an  equation  of  the 

9(q.,.q2>q3) 


HSC.|  i where  p1>p2>p3  are  given  by  equations  (6.32)  - (6.34).  Consider 

now  the  angles  and  0^  for  the  E(PRR)-4,  E(PRP)-4  manipulators;  and 

a_,  and  0"  for  the  E(PPR)-4  manipulators.  Here  a__  [a-,-]  is  the  angle 
5 35  35 

measured  from  S_  to  S_  [S, ] around  a__  = S_  x Sc  [a « S_  x S,]  and 
-3  -5  -6  -35  -3  -5  -36  -3  —6 


0^[0”]  is  the  angle  measured 

from  a23  to  [aJ6] . 

These  angles  are 

given  by  the  equations 

°35  = ~S34C4 

2 2 

S35  S34°4 

(5.84) 

0^  = ©3  + y ' 

(5.85) 

c36  = S3i|S4 

✓ , 2 2 
S36  = 1 s34s4 

(5.86) 

0^  = 03  + Y" 

(5.87) 

where 

cos  Y'  = c34c4/s35 

, sin  Y*  = s4/s35 

(5.88) 

003  Y"  - -031|31)/336 

, sin  Y"  = c4/s36 

(5.89) 

and  = cos  a^,  s^  = sin  at^,  etc.  Suppose  now  that  and 
©3  in  the  right-hand  sides  of  the  equations  (6.32)  - (6.34)  are 
replaced  by  and  0^.  The  resulting  expressions  thus  obtained  from 
(6.32),  (6.33)  yield  the  p^  and  p2  coordinates  of  the  wrist  plane  of  a 
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E(PRR)-4  or  E(PRP)-4  manipulator.  The  expression  obtained  from 

(6.34),  plus  a term  which  does  not  involve  any  joint  variables,  yields 

the  p^  coordinate  of  the  wrist  plane.  It,  therefore,  follows  that  the 

points  on  HSC^  (i.e.,  the  singular  points  of  the  transformation 

representing  the  positioning  of  the  wrist  plane)  for  the  PW 

manipulators  belonging  to  the  classes  E(PRR)-4  and  E(PRP)-4  can  be 

obtained  from  equations  (5.80)  - (5.83)  after  replacing  and  0^  by 

a and  0'.  Similarly,  a-,,  and  0_  in  equations  (5.80)  - (5.83)  should 
3b  3 34  3 

be  replaced  by  a^g  and  0^  if  the  manipulator  belongs  to  the  class 
E (RRP)-4. 

5.4.2  Spherical  Wrist  Manipulators 

For  an  SW  manipulator  |j|  = | | |M^|  (see  equation  (4.7))  and 
the  equations  of  the  2 component  manifolds  of  the  HSC,  HSC-| -|  and 
HSC22.  are  |m2I=0  and  lM3l=0»  respectively.  The  3x3  matrix  is 
defined  by  equation  (4.8)  and  hence  an  equation  of  the  HSC22  is  given 
by  (also  see  Paul  and  Stevenson  (1983)) 


S^S^S 

45  56  s 


0 


(5.90) 


The  matrix  M2  depends  on  the  types  of  the  first  3 joints  of  the 
manipulator.  The  equations  of  HSC1 -j  , given  by  | M | =0 , are  listed 
below  for  all  possible  types  of  SW  manipulators. 

PPPS  Manipulators: 


s s s 
12  23  2 


0 


(5.91) 
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RPPS  Manipulators: 


323Cai2°1232  * VS12323°233  " VWs'  * S22312°2 


+ S (s  o c + c s ) 1 = o 
33  12  23  2 12  23 


PRPS  Manipulators: 


a23S12C23S2  + a34(S12C23S2C3  + S12C23C2S3  + C12S23C23S3) 


S33(S12S23C23C2  + °12S23)  " ° 


PPRS  Manipulators: 


a , s (c  sc  + c s ) = 0 
3H  1 2V  23  2 3 23 


PRRS  Manipulators: 


a3'tCa23<312323S2°3  * °12s3*  + a3« ( S1 2323°2302S3°3 

* 3t2s2332°3  * °12s303  ' °12023S303)  * S33(°1 2323°23°3 


' 312323°2°3,]  ‘ 0 


RPRS  Manipulators: 


a3*C‘ai2(C12°233  + C12C23S2C3)  ' a23°12S3 

a3J1(s12S23S2S3  ’ 312323C23C2S3C3  + °1  2C2333°3  ~ C 1 2s 3° 3 ' 


+ S22(312S233  " S12C23C2C3)  + S33 ( 31 2C23S2S3 


S12C23C2C3  " C12323G23C3)'1  ° 


(5.92) 


(5.93) 


(5.9H) 


(5.95) 


(5.96) 
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RRPS  Manipulators: 


ai2['a23C12C2332  + a34(C12C23S2C3  + °12C23G233 


S1 2S23°23S3)  + S33(S12S23  " °1 2S23C23C2) ] 


+ a23(S22312C23°2  + S33S12C2)  + &34 1”S22 ( 3 1 2°23C2C3 


S12G23S2S3)  + S33(S12G2G3  " 31 2C23S2S3) ^ 


+ S33(S22312323G2332  + S33312S23S2)  = ° 


(5.97) 


RRRS  Manipulators: 


Val2Ca23(G12323S2G3  " 312S3}  + a3^ ( 3 1 2°23 S3 °3  ' 31 2S3C3 

+ G1 2S2332°3  + G12323G23G2S3G3)  ~ S33 (31 2323°23G3  + G23323G2°3)] 
+ a23["a23S12G2S3  + a3M(312G23S233  ~ S12G2S3G3) 

2 

+ S^s„  „s„„c„c„  - S„„s.,  _s__s„s_  ] + a„„S„„(s,  „s„„c„c,, 

22  12  23  2 3 33  12  23  2 3 34  22  12  23  2 3 


" 31 2S23G23S2S3C3)  + S22S33312S2332G3J  “ ° 


(5.98) 


Equations  (5.91)  - (5.98)  have  been  obtained  by  assuming  that  S^=0 
since  such  an  assumption  simplifies  them  extensively.  These  equations 
yield  the  singular  points  of  the  mapping  representing  the  positioning 
of  the  wrist  point  H (see  the  proof  of  Theorem  4.1)  and  the 


coordinates  of  this  point  in  the  reference  frame  B^  is  (a^c^.a^s^.S^) 
If,  however,  the  coordinates  of  H expressed  in  will  be 

(a34C3 ,a34s3 ,833) • Here»  c^=cos  9^,  s^=sin  9^  and 
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. v2  ~2  2 

a34  a3M  + SHHs3H 


S33  = S33  + S44°34 


(5.99) 

(5.100) 


0^  = 03  + Y 


(5.101 ) 


where  Y is  determined  from 


cos  Y - a34/a'4 


sin  Y = -(S44s34)/a-4  (5.102) 


It  thus  follows  that  the  equations  of  the  HSC^  for  all  types  of  SW 
manipulators  with  S44*0  can  be  obtained  from  (5.91)  - (5.98)  upon 
replacing  a^,  S33  and  03  by  a^4 , S^3  and  0^,  respectively. 


CHAPTER  6 

CONFIGURATIONS  OF  6 DEGREE-OF-FREEDOM  MANIPULATORS 

6.1  One-to-Onenesa  of  the  Configurations 
The  measure  HFN(CO^)  can  be  directly  computed  from  equation  (4.1) 
iff  the  Forward  Displacement  Mapping  (FDM)  is  one-to-one  when 
restricted  to  the  region  (see  Section  3.4  for  the  definition  of 
COj^).  If,  on  the  other  hand,  FDMlCOj^  is  not  one-to-one,  then  it  is 
necessary  to  partition  the  region  CO^  into  subregions  such  that 
FDM Id, 4 is  one-to-one,  U D. . = CO.  and  D. . n D.,  =4.  The  measure 

^ ^ IK 

HFN(CO^)  is  then  given  by  £ HFN(D_)  where  each  HFN(Djj)  is  computed 
from  equation  (4.1).  Clearly,  the  identification  of  the  regions  Djj’s 
and  the  computation  of  the  corresponding  measures  HFN(D^j)'s  can  be 
quite  challenging.  Hence  it  is  useful  to  be  able  to  identify  the 
manipulators  for  which  FDMlCOj^  is  one-to-one.  For  these  manipulators, 
the  motion  planning  and  quick  decision  making  algorithms  may  be 
rendered  more  efficient  by  taking  advantage  of  the  one-to-oneness  of 
the  regions  CO^s.  Furthermore  DEG  _<  NC  and  DEG1  < NC  (see  Section 
3.4  for  the  definitions).  The  second  inequality,  for  instance,  can  be 
used  at  the  design  stage  when  the  joint  limitations  are  determined. 

In  this  section  a theorem  on  the  one-to-oneness  of  FDMlCO^  is 
proved.  This  theorem  is  applicable  to  a broad  class  of  manipulators 
(to  be  defined  in  the  next  paragraph) . Global  univalence,  i.e.,  one- 
to-oneness,  theorems  can  be  used  for  the  manipulators  which  are  not 
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covered  by  the  theorem  proved  here.  Parthasarathy  (1983)  presents  a 
comprehensive  review  of  the  currently  existing  theorems.  These 
theorems  consider  differentiable  maps  of  the  form  F:D  c Rn  ■*  Rn 
and  state  the  conditions  on  the  map  F and  the  region  D such  that  F | D 
is  one-to-one.  However,  in  most  cases  D is  assumed  to  be  rectangular 
and  the  conditions  on  F are  difficult  to  check  and  satisfy. 

A 6 DOF  manipulator  will  be  said  to  be  an  echelon  manipulator  if 
it  has  the  following  properties  (this  definition  has  been  inspired  by 
Litvin  and  Castelli,  1985): 

(i)  The  FDM  (from  the  joint  space  into  the  POH  space)  can  be 

represented  by  a finite  number  of  class  transformations.  Each 

such  transformation  T^:H  -*•  R°  is  given  by 

vj  = fJ(£)  (6.1 ) 

where  vJ  is  a coordinatization  of  a portion  of  the  POH  space, 
q=(9l  ,q2> . . . ,qg)  is  the  joint  variable  vector  and  H is  a hyperprism  in 
the  joint  space  (see  Section  3.2).  The  domain  of  each  coordinatiza- 
tion vJ  is  an  open  subset  of  the  POH  space,  , and  u D"1  covers  the 

i k j 

POH  space.  If  v and  v are  two  such  coordinatizations  and 

fl  Dk  * <j>,  then  there  exists  functions  g and  g.^  such  that 

J K J K 

XJ  - Sj k(Xk)  . vk  = £^(vj)  (6.2) 

for  all  points  in  n Dk. 

(ii)  The  equation  set  (6.1)  can  be  transformed  into  the  echelon 


form 
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F'j(vJ,q1)  = 0 


F2(IJ  ’qi ’ q2^  = 0 


(6.3) 


Fg  (^ " > Q.j  i Q2 » • • • *Qg ) = 0 


for  each  transformation  TJ . Furthermore,  for  e=1,2,...,6 


m 

6 

Fe(XJ’qi’q2 qe}  = ,n.  Fe;b(-J,ql,q2,**'’qe) 

D=  1 


m 


n (ij  ..  c + ij  s + iJ  _.  ) 
b , e;1b  e e;2b  e e;3b 


(6.4) 


or 


Fe(— ^ ,q2 V ' ''eo'e  * Je;2 


(6.5) 


if  qg  is  an  angular  joint  variable;  and 


Fi(IJ’q1»q2'*“’qe)  = n Fe;b(-J  ,q1  ,q2 qe^ 


b=1 


m 


n (KJ  n2  + KJ  n + Kj  „ ) 
e;1bMe  e;2bMe  e;3b 


b=1 


(6.6) 


or 


i(IJ-qrq2 qe>  - Le;1%  * Le; 


(6.7) 
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if  q is  a linear  joint  variable.  Here  c =cos(q  ),  s =sin(q  ), 
e e e e e 


Ke ; 3b » Li;1'  Li;2  are  continuous  functions  of  vj  , qi , q2 qe_1 . 


(iii)  The  pre-images  of  any  given  point  in  the  POH  space  can  be 


solving  q, ,q_,...,q£  from  the  first,  second,  . . . , sixth  equation  of 
1 d b 

the  set  (6.3).  This  process  should  yield  precisely  the  pre-images  of 
the  given  point  and  nothing  else. 

(iv)  If  the  first  m equations  (m=1 ,2, . . . ,5)  of  the  equation  set 


exist  at  least  one  corresponding  real  point  (qm+1 .qm+2» • • • »Qg)  which 
satisfies  the  remaining  (6-m)  equations. 

Theorem  6,1:  Every  region  CO^  corresponding  to  the  i'th  configuration 

of  an  echelon  manipulator  is  mapped  onto  its  image  in  a one-to-one 
manner  under  the  forward  displacement  mapping. 

Proof : The  superscript  j in  equations  (6.1)  and  (6.3)  - (6.7) 

(designating  the  coordinatization  used)  will  be  dropped  throughout  the 
proof  in  order  to  simplify  the  notation;  i.e.,  the  (generic)  forward 
displacement  map  will  be  represented  by  the  equivalent  equations 


determined  via  an  appropriate  transformation  T^  by  successively 


(6.3)  are  satisfied  by  a real  point  (v^,q  ,q 


q ) , there  should 
Mm  ’ 


v = f (£) 


(6.8) 


and 


Fe(^VQ2 V ' WV  ' 0 (e-’'2 


» • • * f 


6) 


(6.9) 


where 


135 


Vg  s (vfq  ,q  , . . . ,q  ) (6.10) 

and  the  coordinate  functions  of  equation  (6.8)  are  given  by  v^=f  (£) 
for  i«1 ,2, ...  ,6.  Here  v=( v, , v„ , . . . , v, ) designates  any  one  of  the 

— i 2 b 

coordinatizations  depending  on  the  portion  of  the  POH  space  under 
consideration.  When  it  is  necessary  to  change  coordinates,  equation 
(6.2)  can  be  used  without  affecting  the  outcome  of  the  proof. 

For  the  sake  of  clarification,  the  proof  is  divided  into  2 parts. 
Part  1 

The  Jacobian  of  the  equation  system  (6.9)  is  given  by 


9(^1 2 • • • • »^g) 

3(V^T7^) 


6 

11  Ge(I'qi’q2’ 
e=1 


,qe} 


(6.11) 


where 


Ge(— ,qi 


2 ' 


-qe} 


G_(v  , 
e — e 


V 


aFe(I'qi 


i2  ’ 


.qe) 


9q, 


(6.12) 


3(f  ,f  ,...,f6) 

for  e=1,2,...,6.  The  equations  I J I =0 , -r~, r = 0 and 

9 (q^ » q 2 » • • • * q6 ) 

6 

H G (f (£)  ,q  ,q  , . . . ,q  )=0  are  equivalent  since  the  solution  set  of 
e=1  e 1 ^ e 

each  equation  yields  the  singular  points  of  the  forward  displacement 
map.  Singular  points  are  points  in  the  hyperprism  H for  which  the 
rank  of  the  induced  linear  map  (between  the  tangent  spaces  of  the 
joint  and  POH  spaces)  is  strictly  less  than  6 (see  Gibson,  1979,  for  a 
detailed  coverage  of  the  singularity  theory  and  the  associated 
concepts) . 
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Part  2 

Consider  any  point  D in  the  POH  space  which  is  not  on  the 
bifurcation  set,  i.e.,  the  image  of  the  singularity  set.  The  pre- 
images of  D obtained  by  solving  equation  system  (6.9)  must  all  be 
distinct.  Let  the  coordinates  of  the  point  D and  its  pre-images 
(which  are  assumed  to  be  r in  number)  be  designated  by  v^  and 

•^a=^qi  ;a,q2;a’ * * ' ,q6-a^ ’ re3Pectively * where  a-1 ,2, . . . ,r  (see 
Fig.  6.1).  Consider  now  any  one  of  the  pre-images  of  D,  say  . 
Define 


Q 2 {q  : v = v , and  q *q  } 
e -a  -e;a  -e;1  e;a  e;1 


(6.13) 


for  all  e such  that  ee{ 1 ,2, . . . ,6}  and  F (v  ,q  ) is  given  by  either  one 

e — e e 

of  the  equations  (6.4)  or  (6.6),  i.e., 


m 

e 

F (v  ,q  ) = n F ( v , q ) 
e -e  e e;b  -e,Me 


(6.14) 


where  <V<l,.a.«2;a V,.a>- 

Consider  now  the  pre-image  of  the  point  D with  the  coordinate 

vector  £2>  This  vector  must  belong  to  at  least  one  set  Qg  defined  by 

equation  (6.13).  Suppose,  for  example,  that  it  belongs  to  Q^;  i.e., 

I3;2=I3;1  and  Let  0 denote  any  one  of  the  infinitely  many 

continuous  paths  in  the  joint  space  which  join  and  £2  (see 

Fig.  6.1).  The  path  corresponding  to  c in  the  v q space,  c,  joins 

the  points  A and  B with  coordinates  (v  ,q  ) and  (v  .a  ) 

—3 ; 1 3 ; 1 —3;  1 3;2" 

respectively.  A parametric  representation  of  c can  be  obtained  by 


Joint  Space  POH  Space 


Fig.' 6.1  The  Point  D and  Its  Pre-images 
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using  a parametric  representation  of  c and  equation  (6.8).  Hence 
every  point  on  the  path  c and  the  end  points  A ,B  satisfy  the  equation 
)=o . The  function  F^(v^,q^)  [obtained  from  equation  (6.14) 
with  e=3]  can  be  expressed  in  the  form 


F3*-3,q3^  - gh 


(6.15) 


where  g denotes  the  function  F^Cv^.q^)  such  that  F^>d(v  1 ,q  ^ )=0 
and 


b*d 


(6.16) 


The  function  C^^^)  can  be  obtained  in  terms  of  the  functions  g and 
h by  differentiating  equation  (6.15)  with  respect  to  q^.  Hence, 


vw 


3F(v3, q3) 


g'h  + h'g 


(6.17) 


where  g'=  and  h'=  . The  functions  g,  h,  g'  and  h'  are 

dq^  d(^3 

continuous  since  the  functions  F (v  ,q  ) and  their  partial 

J 9 D i J 

derivatives  with  respect  to  q are  continuous  (see  the  definition  of 

these  functions  given  by  equation  (6.4)  or  (6.6)).  The  equations  g=0 

and  h=0  define,  respectively,  the  hypersurfaces  denoted  by  M and  M 

g h 

in  the  v^  space.  It  follows  from  the  definition  of  g that  the  point 

A is  always  on  M . However,  B can  lie  on  either  M or  M,  . 

g g n 


B e M 


« 


The  point  D (in  the  POH  space)  is  not  on  the  bifurcation  set  by 
hypothesis.  This  means  that  the  pre-images  q^  and  q^  are  not  on  the 
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HSC  given  by  | J | =0 . Hence  from  the  result  of  Part  1,  the  value  of  the 

function  G^(v 3^3^  no^  e9ua^  to  zer°  at  the  points  A and  B.  Since 

g(A)=g(B)=0  and  G^(_v^ ,q^)  is  given  by  equation  (6.17)  it  follows  that 

h(A)*0,  h(B)*0;  i.e.,  A t Mh,  B t Mh. 

The  equation  g|  _ =0,  i.e.,  the  function  g restricted  to  the 

— 3=— 3;  1 

line  v =v  equated  to  zero,  represents  a single  equation  in  a single 
i 5 5 ■ 

unknown,  q . The  q coordinates  of  the  points  A and  B,  i.e.,  q 

J J J 9 I 

and  q , are  the  two  distinct  roots  of  this  equation  which  clearly 

J 1 £ 

cannot  have  more  than  2 roots.  Hence,  sgn(g' (A) )=-sgn(g' (B) )^0  where 
sgn  denotes  the  sign  function  and  g'(A),  g’(B)  denote  the  values  of 
the  function  g'  evaluated  at  the  points  A,B  (recall  that  the  roots  of 
an  equation  f(x)=0  are  separated  from  each  other  by  the  roots  of 
f’(x)=0).  Therefore,  there  must  exist  at  least  one  point  A e c such 
that  g* (A )=0. 

Consider  now  the  path  c e Mg  U (see  Fig.  6.2).  If  the  entire 

path  c lies  on  M then  g'  (A  )=g(A  )=0;  and  hence  the  function  G_(v _,q _) 
g 3 3 3 

is  zero  at  the  point  A (see  equation  (6.17)).  If,  on  the  other  hand, 

c does  not  entirely  lie  on  M then  there  exists  a point  B e c such 

g 

that  D (note  that  c,  and  are  continuous) . Hence 

g(B)=h(8)=0;  and  the  function  G^v^.q^)  is  zero  at  the  point  B (see 
equation  (6.17)). 

5_£Jlh 

It  can  be  shown  that  A i Mh  and  B t Mg  by  analogy  with  the  first 

paragraph  of  the  case  B e M . Furthermore,  by  hypothesis  A e M and 

g g 
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Fig.  6.2  The  Case  B e M 

g 
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B e M^.  Since  c,  Mg  and  are  continuous  and  c e Mg  U there 

exists  a point  Y e c such  that  Y e M DM.  Hence  g(Y)=h(Y)=0;  and 

S h 

the  function  G^Vg^)  is  zero  at  the  point  y (see  equation  (6.17)). 

The  above  two  cases  indicate  that  there  always  exists  at  least 
one  point,  say  a,  on  c such  that  the  value  of  the  function  G^(v^,q^) 
is  zero  at  a.  It  then  follows  from  the  result  of  part  1 that  there  is 
a corresponding  point,  a,  on  c such  that  |j|=0.  Hence  the  pre-images 
with  the  coordinate  vectors  ^ and  cannot  be  in  the  same  region 
CCh  (recall  that  c denotes  any  one  of  the  infinitely  many  continuous 
paths  joining  £ and  £2  in  the  joint  space).  Analogously,  it  can  be 
shown  that  and  q^,  q^  and  q^ , . . . , q^  and  q^  cannot  belong  to 
the  same  region  CCK  . The  theorem  then  follows  immediately  since  each 
pre-image  of  the  point  D belongs  to  a different  region  CCh. 

■ 

The  reverse  displacement  analyses  of  all  types  of  SW  manipulators 
(involving  the  positioning  of  the  wrist  point)  are  presented  in 
closed-form  by  Kohli  and  Spanos  (1984a,  1984b).  Using  these  analyses 
it  can  be  shown  that  the  SW  manipulators  RPPS,  PRPS,  PPRS,  PPPS  are 
echelon  manipulators  and  hence  Theorem  6.1  is  applicable  to  them.  For 
each  of  the  remaining  types  of  SW  manipulators  it  is  necessary  to 
substitute  the  dimensions  of  the  manipulator  into  the  equation  system 
representing  the  reverse  displacement  analysis  which  is  of  the  form  of 
equation  (6.1).  The  SW  manipulator  under  consideration  will  be  an 
echelon  manipulator  if  each  equation  of  this  system  can  be.  expressed 
in  either  one  of  the  forms  given  by  equations  (6.4)  - (6.7).  It 
should  be  noted  that  Kohli  and  Spanos  (1984a,  1984b)  give  three 
alternative  reverse  displacement  analyes  [as  opposed  to  1 in  the 


original  work  of  Pieper  (1969)]  for  each  type  of  SW  manipulator.  Here 
any  one  of  these  analyses  can  be  utilized. 

6.2  Planar  Wrist  Manipulators 

In  this  section  the  PW  manipulators  are  investigated  in  detail. 
Firstly  the  reverse  displacement  analysis  is  performed  using  the 
concept  of  signed-planes.  The  solutions  thus  obtained  for  the  joint 
variables  can  be  efficiently  used  for  kinematic  synthesis  and  on-line 
computation  purposes.  Furthermore  the  totality  of  the  uncertainty  and 
stationary  configurations  are  identified  using  these  solutions.  The 
reverse  displacement  analysis  also  reveals  that  the  PW  manipulators 
PRRE,  RPRE  and  RRPE  are  echelon  manipulators  and  hence  Theorem  6.1  is 
applicable  to  them. 

6.2.1  Signed-Planes 

Consider  the  set  of  all  planes  in  R3.  Let  2 free  vectors, 

Hi  and  H2.  be  attached  to  every  plane  in  this  set.  These  vectors  are 

normal  to  the  plane  and  furthermore  N^-N^  1^  |2=  |N2 f2=1 . The  set 

which  consists  of  all  the  planes  in  R3 , together  with  their 

corresponding  and  N2  vectors  attached  to  them,  will  be  called  the 

signed-plane  space  (SP  space) . It  should  be  noted  that  the  plane  P 

with  Ni  attached  to  it  is  considered  to  be  distinct  from  the  same 

plane  with  attached  to  it.  Now,  let  N=(N  ,N  ,N  ) designate  either 

— x y z 

one  of  the  normal  vectors  or  N . The  set  of  all  signed-planes  in 

the  SP  space,  excluding  the  ones  for  which  N =1 , can  be  identified  by 

z 

finite  vectors  of  the  form  p-tp^p^p  ) which  will  be  called  the 


p-coordinatea . Here, 


Pl  - \/(1  - Nz)  (6.18) 

p = N /(I  - N ) (6.19) 

c.  y z 

P3  - N • r (6.20) 

and  r_  is  the  position  vector  of  any  point  on  the  signed-plane.  It 
should  be  noted  that  |p^|  is  the  minimum  distance  between  the  signed- 
plane  and  the  origin. 

When  the  coordinate  vector  £ is  given,  £ can  be  obtained  from  the 
equations 


N = 2p  /D 
x 1 


Ny  = 2p2/D 

Nz  = + P2  “ 1)/D 


2 2 

where  D=p  +p  +1 . Furthermore, 


r = 

-m 


(6.21 ) 
(6.22) 
(6.23) 


(6.24) 


where  r^  is  the  position  vector  of  the  point  on  the  signed-plane  which 
is  closest  to  the  origin.  Thus,  the  signed-plane  corresponding  to  p 
can  be  determined  uniquely  from  equations  (6.21)  - (6.24). 

The  SP  space  can  also  be  coordinatized  via  finite  vectors  of  the 
form  n»(n^ ,n2>n^)  which  will  be  called  the  n-coordinates.  Here, 
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n = N /(I  + N ) 
x z 


n = N /(I  + N ) 
2 y z 


n3  = P3  =■  N • r 


(6.25) 

(6.26) 
(6.27) 


The  equations  of  the  inverse  transformation  are 


N = 2n  JE 
x 1 


(6.28) 


2n  /E 
2 


(1  - n;  - 


n22)/E 


(6.29) 

(6.30) 


r = n„N 

-m  3— 


(6.31) 


2 2 

where  E=n  +n  +1 . In  this  coordinatization  the  signed-planes  for  which 

N =-1  are  excluded, 
z 

It  should  be  noted  that  equations  (6.18)  and  (6.19)  ((6.25)  and 

(6.26))  represent  the  stereographic  projection  where  the  points  on  the 
2 2 2 

unit  sphere  N +N  +N  =1  are  projected  onto  the  equatorial  plane  N =0 
x y z z 

using  the  north  pole  N=(0,0,1)  (south  pole  N=(0,0,-1))  as  the  center 

of  projection  (see,  for  example,  Klein,  1939).  Therefore  the  equator, 

the  northern  (southern)  hemisphere  with  the  north  (south)  pole 

deleted,  and  the  southern  (northern)  hemisphere  are  mapped  onto  the 
2 2 2 2 

unit  circle  p^+p^l  (n^+n^l),  the  exterior  of  the  unit  circle,  and 
the  interior  of  the  unit  circle,  respectively.  The  north  (south)  pole 
is  the  vanishing  point  of  the  transformation  and  is  mapped  onto  the 
line  at  infinity  in  the  P1P2  ^nin2^  Piane* 
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6.2.2  Reverse  Displacement  Analysis 

The  signed-plane  which  contains  the  point  0^,  i.e.,  the  tip  of 

the  vector  a^a^,  and  has  a norraal  parallel  to  the  6 ' th  revolute 

joint  axis  where  6e{4,5,6}  will  be  called  the  wrist  plane  of  the  PW 

manipulator.  Here  6 depends  on  the  class  of  the  PW  manipulator.  The 

p-coordinates  of  the  wrist  plane  (in  terms  of  the  joint  variables)  can 

be  determined  in  any  coordinate  system.  Suppose,  for  example,  that 

5=4  and  the  reference  frame  to  be  used  is  B . Hence,  N=(N  ,N  ,N  ) 

1 - x y z 

in  equations  (6.18)  and  (6.19)  must  be  replaced  by 
-4,1=(X123,X123’Z23)  (3e®  Table  2,1 ) yieldin8 


xi23/d  - z23) 


P2  = X123/(1  ' Z23} 


(6.32) 

(6.33) 


The  p^  coordinate  is  obtained  from  equation  (6.20)  yielding 
P3  ~ -4  (S11-1  + ai 2—1 2 + ^22—2  + a23~23  + S33~3  + a34^34) 


S11Z23  + ai2X23  + S22Z3  + a23X3  + S33°34 


where  the  inner  products  have  been  evaluated  by  noting  that 


(6.34) 


a..  * S = X and  S • S = Z (see  Table  3-1. a in  Lipkin 

-hi  -m  ij . . ,m  — h -m  ij...m  ■ 

and  Duffy,  1984). 

The  coordinates  of  the  wrist  plane  can  also  be  determined  in 
terms  of  the  location  of  the  end  effector  which  is  usually  specified 
by  the  vectors  R,  and  agy*  Here  all  3 vectors  are  expressed  in  a 
convenient  fixed  coordinate  system  and  R denotes  the  position  vector 


of  Og.  For  example  if  the  PW  manipulator  belongs  to  the  class 

E (RRR) -4,  then  p1  and  p^  can  be  obtained  from  equations  (5.18)  and 

(6.19)  where  N , N and  N are  replaced  by  the  components  of  Sc. 

x y z 6 

The  p^  coordinate  is  given  by 


P 


3 


(S 


44 


+ S 


55 


*S66> 


(6.35) 


Similarly,  the  p-coordinates  of  the  wrist  plane  can  be  easily 
determined  (using  R and  S-)  for  the  remaining  classes  of  PW 

— — D 

manipulators  (see  Table  5.2).  In  the  remainder  of  this  section  it 
will  be  assumed  that  p^ , p^  and  p^  have  been  computed  and  are 
available  as  numbers. 

The  joint  variables  q^ , q^  and  q^  will  now  be  determined  in  terms 
of  P1 » P2  and  p . This  process  is  dependent  on  the  types  of  the  first 
3 joints  and  the  class  of  the  manipulator.  Hence  the  PW  manipulators 
RRRE , RPRE,  RRPE  and  PRRE  will  be  analyzed  individually  assuming  that 
5=4,  i.e.,  the  manipulator  belongs  to  either  one  of  the  classes 
E(RRR)-4,  E(RPR)-4,  E(RRP)-4  or  E(RPP)-4.  The  PW  manipulators 
belonging  to  the  classes  E(PRR)-4  or  E(PRP)-4,  i.e.,  5=5,  or  to  the 
class  E(PPR)-4,  i.e.,  5=6,  can  be  analyzed  in  exactly  the  same  way. 

In  the  following  analyses  the  coordinates  of  the  wrist  plane  are 

AAA 

formulated  in  the  reference  frame  ((^x  y z ) except  for  the  PRRRE 

AAA 

type.  Here  (O^x^y^z^)  designates  the  coordinate  system  whose  origin 
is  at  01  and  whose  axes  are  parallel  to  those  of  B . In  the  PRRE 

A A A A 

manipulator  the  frame  (O.jX^z  ) 13  emPloyed* 
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RRRE  Manipulators:  The  and  coordinates  of  the  wrist  plane 


AAA 


(expressed  in  the  (O.jX^z  ) system)  are  given  by  equations  (6.32)  and 
(6.33).  respectively,  whereas 


p = S Z + S c,+a  X + a X 
f3  22  3 33  34  12  23  23  3 


(6.36) 


Equations  (6.32)  and  (6.33)  can  be  solved  for  s^  = sin  0^  and 


1 , yielding 

(p2X23  “ piY23)/(1  + Z23) 

(6.37) 

(P1X23  + P2Y23)/(1  + Z23) 

(6.38) 

These  equations  will  yield  a real,  unique  0^  iff 


Z = p 

23  o 


(6.39) 


AAA 


which  is  essentially  equation  (6.23)  expressed  in  the  (O^y  z ) 
system.  Here 


_ / 2 2 , w,  2 2 , , 
p0  “ + P2  “ 1 + p2  + 1) 


(6.40) 


Equations  (6.36)  and  (6.39)  can  be  solved  for  s^  and  c^,  yielding 
S2  = (ai2°12X3Z3  ~ a23S1 2X3Y3  ~ S22S12Y3Z3  ~ S33S12°34Y3 


" poal2X3  + P3312Y3)/A 


(6.41) 


°2  = (a23S12X3  + S22S12X3Z3  + ai2°12Y3Z3  + S33S1 2°34X3 


- p a,  _Y_  - p„s.X„)/A 
o 12  3 3 12  3 


(6.42) 
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provided  that  A*0,  where 


4 - a,2312<Z3  - 1> 


(6.43) 


These  equations  will  yield  a real  0 iff 

,2  2 2.2  , 2 2.2  , „ _ 2 2, 

(a23312334)s3  + DS23S34)C3  + (_2a23S2231 2323334)33°3 

(2a23S22S12C23334C34  + 2a23S33S1 2334°34  " 2p332331 2334)33 

+ (“2DS23C23334C34  ' 2S22S33312S23S34C34  + 2po4>°1 2323S34 

2p3S22S12323334)C3  + (DC23°34  “ ai2S12  + 2S22S33S1 2°23C34 
+ S23s22c31|  + p2a22  - 2poa22c12c23c3l|  + p2s22  - 2P3S22s1 2o2f^ 


“ 2p3S33312c34}  " 0 


(6.44) 


2 2 2 

where  D = a^  2 + S22312‘  The  Joint  varisble  03  can  be  determined  by 
transforming  equation  (6.44)  into  a quartic  in  t3  = tan(©3/2) . The 
corresponding  values  of  02  and  0^  can  be  obtained  from  equations 
(6.41),  (6.42)  and  (6.37),  (6.39),  respectively. 

The  above  reverse  displacement  analysis  is  modified  if  A,  which 


consists  of  3 factors,  is  equal  to  zero.  When  a^  = 0,  03  is  solved 
using  equation  (6.36)  which  simplifies  to 


(S  s s , ) c + (-a  s , ) s + (p  - S c c , - S c,) 
22  23  34  3 23  34  3 3 22  23  34  33  34 


(6.45) 


This  equation  yields  at  most  2 values  of  03  and  the  corresponding  0^ 
values  are  solved  from  (6.39)  which  can  be  expressed  in  the  form 
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<312V°2  + <312X3,32  * (°12Z3  - Po>  * 0 
Equation  (6.46)  yields  at  most  2 values  of  0^ 
corresponding  0^  values  can  be  obtained  from 


(6.46) 

for  a given  0 The 
equations  (6.37)  and 


(6.38). 


When  the  second  factor  of  A,  s , is  zero,  equation  (6.39)  can  be 
expressed  in  the  form 


°3  ' (°12023°3U  ‘ Po)/(o12323334) 


(6.47) 


which  yields  at  most  2 solutions  for  0 . The  corresponding  0^  values 
(at  most  2 for  each  0 ) are  obtained  from  equation  (6.36)  which  can  be 
arranged  in  the  form 


(ai2X3)02  * C_ai2Y3)S2  * 


<a23X3  * S22z3  " S3303‘l  " P3> 


(6.48) 


The  joint  variable  0^  can  then  be  obtained  using  equations  (6.37)  and 

(6.38) .  Finally  when  the  last  factor  of  A,  {Z  - 1),  is  equal  to 
zero,  the  manipulator  is  in  an  uncertainty  conf iguration  (see  Section 
6.2.3) . 

RPRE  Manipulators;  The  joint  variable  0^  is  solved  using  equation 

(6.39)  which  can  be  expressed  in  the  form 


(S3J»V°3  + (S34VS3  + (c34Z2  “ po}  = 0 (6.49) 

This  equation  yields  at  most  2 solutions  for  0 . The  corresponding 
values  of  0^  and  S^2  are  determined  from  equations  (6.37),  (6.38)  and 
(6.36),  respectively. 
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RRPE  Manipulators:  The  joint  variable  0 is  solved  using  equation 

(6.39)  which  can  be  expressed  in  the  form 

(312I3)02  * (312X3)S2  * (C12Z3  - p0>  ' 0 (6-50) 

This  equation  yields  at  most  2 solutions  for  Q^.  The  corresponding 
values  of  0^  and  are  determined  from  equations  (6.37),  (6.38)  and 
(6.36),  respectively. 

PRRE  Manipulators;  The  p^  and  p^  coordinates  of  the  wrist  plane 

AAA 

(expressed  in  the  (®-\x2y2Z2^  3y3^era^  are 

P1  = X23/(1  ' V (6.51) 

P2  = X23/(1  " V (6.52) 

and  the  p^  coordinate  is  given  by  equation  (6.34).  Equations  (6.51) 
and  (6.52)  can  be  solved  for  s^  and  c , yielding 

3 2 “ (P2X3  “ Piy3>/(1  + z3>  (6.53) 

°2  = (P1X3  + P2Y3)/(1  + z3}  (6.54) 

These  equations  will  yield  a real  0^  iff 

z3  = P0  (6.55) 

A A A A 

which  is  essentially  equation  (6.23)  expressed  in  the  (O^x^Zg) 
system.  The  joint  variable  0^  can  be  solved  by  expanding  equation 
(6.55), 
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°3  ' (°23°34  ' po,/(323V 


-(6.56) 


which  yields  at  most  2 real  solutions  for  0^.  The  corresponding 
values  of  0^  and  can  be  determined  from  equations  (6.53),  (6.54) 
and  (6.31*),  respectively. 

The  joint  variables  , q^  and  q^  can  thus  be  determined  using 

the  above  analyses.  The  remaining  variables  q , q and  q can  be 

4 5 6 

simply  obtained  from  the  reverse  displacement  analysis  of  an 
appropriate  3 DOF  planar  manipulator  which  depends  on  the  class  of  the 
PW  manipulator. 

Suppose,  for  example,  that  the  manipulator  is  of  the  class 

E(RRR)-4.  Let  R = (R  ,R  ,R  ) and  ac  = (a  ,a  ,a  ) denote  the  position 
— x y z —67  x y z 

vector  of  Og  and  the  unit  vector  , respectively.  These  vectors 

AAA 

have  already  been  specified  in  the  (O^y  z^  system.  Further,  let 

L = (r\,»r\,*r  ) designate  the  vector  (a„  a.icr  + ar,ac.)  expressed  in  the 
x y z 45—45  56—56 

a 

coordinate  system  . Clearly, 


1 T 
[Rjj]R 


(ai2^12 


a23~23 


a34-34 


S22^2 


+ 


* S66V 


(6.57) 


Here  the  vectors  in  the  parentheses  should  be  expressed  in  B.  and 

A *T 

[ R*]  is  the  rotation  matrix  given  by  equation  (5.9)  together  with 
g=»4.  The  x and  y components  of  r_  can  be  obtained  by  using  equation 
(6.57)  together  with  Table  3.3  in  Lipkin  and  Duffy  (1985),  yielding 
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"x  " RxP321  " RyU321  + RzX32  ” ai2?32  " a23P3  " *34  " S22X3  (6*58) 


r = -R  + RV  - R Y + a Q +aQ 

y x 321  y 321  z 32  12  32  23  3 


S22Y3  ~ S33S3^ 


(6.59) 


The  angle  Y between  a_„  (i.e.,  x„)  and  ae_  is  determined  from 

—34  4 — 67 


sin  Y =■  -a  Q„„,  + a - a Y„ 

x 321  y 321  z 32 


(6.60) 


cos  Y = a P„,  - a IJ  , + a X„„ 
x 321  y 321  z 32 


(6.61) 


which  are  the  y and  x components  of  a^  (expressed  in  b^), 

respectively.  The  joint  variables  9. , 0 and  0 can  now  be  easily 

4 5 0 

determined  by  analyzing  the  3R  planar  manipulator  shown  in  Fig.  6.3. 
The  fourth  joint  variable  can  be  obtained  by  solving 


<2rxa45)o4  * <2ryV34  * (a56  ' a45  ' rx  ' ry>  ' 0 


(6.62) 


whereas  0_  and  9,  are  determined  from 
5 6 


S5  ' (ry°4  ' V4)/a56’ 


°5  ' ‘Vi.  * ryS4  ' a45,/a56 


(6.63) 


and 


96  = Y ' 04  " 95  (6.64) 

respectively. 

It  follows  from  the  reverse  displacement  analyses  performed  in 
this  section  that  the  RPRE,  RRPE,  PRRE  manipulators  are  echelon 


< >> 
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Fig.  6.3  Planar  3R  Manipulator 
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manipulators  and  hence  Theorem  6.1  is  applicable  to  them.  Here  it 
should  be  noted  that  two  equations  of  the  form  s.  = K/L  and  c.  = M/N 
(for  instance  equations  (6.37)  and  (6.38))  is  equivalent  to  a single 
equation  of  the  form  Qt^  + R =»  0 where  ^ = tan(01/2),  Sj^  = sin  0 
c.  = cos  0.,  Q = f (K,L,M,N) , R = g(K,L,M,N)  and  Q = R = 0 iff 
K=L  = M = N = 0.  Any  RRRE  manipulator  for  which  either  one  of  the 
following  conditions  holds  is  also  an  echelon  manipulator: 

(i)  a12  = 0 or  s = 0. 

(ii)  Equation  (6.44)  can  be  expressed  in  the  form  of  equation 
(6.4),  i.e., 


( 1 1 1 °3  + I21S3  + I31)(I12C3  + I2233  + 132)  ~ 0 


(6.65) 


where  I ,...,I  are  continuous  functions  of  p and  p . 

H 0£  o ^3 

6.2.3  Uncertainty  and  Stationary  Configurations 

Two  distinct  types  of  special  configurations  have  been  identified 
and  named  as  uncertainty  and  stationary  configurations  by  Lipkin  and 
Duffy  (1985).  When  the  manipulator  is  in  an  uncertainty  configuration 
"indeterminacies  occur  in  the  calculation  of  the  joint  variables." 

This  means  that  the  pre-image  of  a point  in  the  POH  space  is  at  least 
a one  dimensional  set  (rather  than  a finite  number  of  points)  in  the 
joint  space.  If  the  manipulator  is  in  a stationary  configuration, 
however,  "it  is  possible  to  compute  the  joint  variables." 

The  uncertainty  and  stationary  configurations  of  the  PW 


manipulators  can  be  identified  using  the  reverse  displacement  analyses 
developed  in  the  previous  section.  Here  only  the  special 
configurations  which  involve  the  positioning  of  the  wrist  plane  will 
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be  considered.  The  remaining  special  configurations  are  the  ones 
associated  with  a planar  3 DOF  robot  which  depends  on  the  class  of  the 
PW  manipulator.  The  types  of  these  special  configurations  can  be 
easily  determined  using  the  reverse  displacement  analyses  for  the 
planar  manipulators  which  are  well  established. 

Consider,  for  instance,  the  RRRE  manipulators.  Equations  (6.37) 
and  (6.38)  will  both  degenerate  when  Z ^ = -1  and  the  value  of  0 
is  indeterminate.  A similar  situation  will  occur  if  the  reverse 
displacement  analysis  is  formulated  in  terms  of  the  n-coordinates  of 
the  wrist  plane  (note  that  the  reverse  displacement  analysis 
formulated  in  terms  of  the  p-coordinates  excludes  the  cases  for  which 
the  p-coordinates  of  the  wrist  plane  is  of  the  form  (»,»,p  )). 

However  in  this  case  the  expressions  for  s1  and  c^  will  degenerate 
when  Z ^ « 1.  Similarly  the  expressions  for  s^  and  c^,  given  by 
equations  (6. Ml  ) and  (6.42),  will  degenerate  when  Z^  * + 1 . The 
uncertainty  configurations  of  the  RPRE , RRPE  and  PRRE  manipulators  can 
be  analogously  determined  using  equations  (6.36),  (6.37),  (6.38), 
(6.34),  (6.53)  and  (6.54).  The  results  are  summarized  in  the  second 
column  of  Table  6.1.  Here  the  joint  variables  which  become 
indeterminate  are  also  indicated  in  parentheses. 

Consider  now  the  equations  (6.44),  (6.49),  (6.50)  and  (6.56)  for 
the  RRRE,  RPRE,  RRPE  and  PRRE  manipulators,  respectively.  Each  of 
these  equations  is  of  the  form 


F(p,q)  = 0 


(6.66) 
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Table  6.1  Uncertainty  and  Stationary  Configurations  of  the  PW 
Manipulators 


Equations*  which 

determine  the 

Manipulator 

Uncertainty 

Configurations 

Stationary  Configurations 

RRRE 

Z23  ‘ ^ ’ 

V; 1 

<V 

<02) 

RPRE 

Z23  ‘ ’ 

V° 

(0,) 

(S22) 

x32  = 0 

RRPE 

Z23  ■ 7 1 

(01 ) 

X23  " ° 

PRRE 

= + 1 

(02) 

s3  = 0 

= 0 
23 

(S„) 

In  these  equations  the  variables  and  0^  should  be  replaced  by 

and  9^  [a^  and  0”]  if  the  PW  manipulator  belongs  to  the 

classes  E(PRR)-4  or  E(PRP)-4  [E (PPR) -4] . The  angles  « , 01, 

35  3 

a_,  and  0"  can  be  obtained  from  equations  (5.84)  - (5.87). 

3b  3 
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where  q denotes  a joint  variable.  Suppose  that  a point  (p^.q^)  in  the 
£q  space  satisfies  equation  (6.66)  and 

3F(p,q) 

3 = G(p,q)  = 0 (6.67) 

3q  - 

This  means  that  qQ  i3  a real,  multiple  root  of  equation  (6.66)  for  the 
given  p^  and  the  point  (j^,q  ) corresponds  to  a special  configuration 
(see  the  proof  of  Theorem  6.1).  Furthermore  since  it  is  possible  to 
compute  the  joint  variable  q,  the  point  (j^,q  ) corresponds  to  a 
stationary  configuration.  The  set  of  all  such  points  (£^,qQ)  make  up 
the  totality  of  the  stationary  configurations.  The  equation  yielding 
these  configurations  in  the  ^ space  a (q^.q^q^)]  is  obtained 

by  substituting  £(q12^)  for  £ ln  equation  (6.67).  Here  the 
substitution  is  made  after  the  differentiation  and  ensures  that 
equation  (6.66)  is  also  satisfied.  Furthermore,  p = £(q12^)  denotes 
the  equation  sets  (6.32),  (6.33),  (6.36)  and  (6.51),  (6.52),  (6.34) 
for  the  RRRE,  RPRE,  RRPE  and  PRRE  manipulators,  respectively. 

The  stationary  conf igurations  of  the  PW  manipulators  can  be 
determined  using  the  method  desribed  in  the  preceding  paragraph.  The 
results,  with  the  exception  of  the  RRRE  manipulator,  are  listed  in  the 
third  column  of  Table  6.1.  It  is  easier  to  determine  the  stationary 
configurations  of  this  manipulator  by  using  the  first  component 
manifold  HSC^  given  by  equation  (5.80).  The  stationary 
configurations  consist  of  all  the  points  on  HSC  ^ excluding  the  ones 
corresponding  to  the  uncertainty  configurations  shown  in  the  second 
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column  of  Table  6.1.  Note  that  the  equations  of  HSC  for  the  RPRE, 
RRPE  and  PRRE  manipulators,  i.e.,  equations  (5.81)  - (5.83),  can  be 


expressed  in  the  forms 

w(-v  ■ 0 

(6.68) 

312W  " ° 

(6.69) 

VVV'V  ■ 0 

(6.70) 

respectively.  Each  of  these  component  manifolds  consists  solely  of 
the  uncertainty  and  stationary  conf igurations  listed  already  in  Table 
6.1,  thus  verifying  the  reverse  displacement  analyses. 

6.2.4  Workspace  of  the  Wrist  Plane 

The  signed-planes  that  can  be  "reached"  by  the  wrist  plane  of  a 
PW  manipulator  can  be  determined  by  mapping  the  first  component 
manifold  of  the  HSC,  HSC^  , onto  the  PrP^  and/or  n^n^  planes.  Here 


p and  n are  defined  as 
r r 

2 2 
P = p,  + p^ 
r K1  v2 

(6.71) 

2 2 
nr  * nl  + n2 

(6.72) 

which,  using  equations  (6.18),  (6.19)  and  (6.25),  (6.26),  yield 


P - (1  + N )/(1  - N ) 
r z z 

(N  * 1)  (6.73) 

Z 

n - (1  - N )/( 1 + N ) 
r z z 

(N  * -1)  (6.74) 

z 

respectively.  This  mapping  can  be  achieved  by  utilizing  an  algorithm, 
the  details  of  which  will  be  presented  using  the  RRRE  manipulator. 
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For  this  manipulator,  the  coordinates  of  the  wrist  plane  are  expressed 

AAA 

in  the  (O^^z.)  system.  Hence  equations  (6.73)  and  (6.74)  yield 


pr  - (i  * z23)/0  - z23) 


np  - (1  - Z23)/(,  * Z23) 


(6.75) 

(6.76) 


and  the  p^  coordinate  (which  is  equal  to  the  coordinate)  is  given 
by  equation  (6.36).  The  algorithm  is  as  follows: 

(i)  The  equation  of  HSC^,  given  by  equation  (5.80),  is  expressed 


in  the  form 


ac  + bs  + d = 0 
2 2 


(6.77) 


where  a,b,d  are  functions  of  0^  and  the  dimensions  of  the 
manipulator. 

(ii)  The  joint  variable  9^  is  initialized.  For  instance  0^  is 
assigned  the  value  zero. 

(iii)  Equation  (6.77)  is  solved  and  the  real  solutions  are 
designated  by  0 ^ and  Q^. 

(iv)  The  quantities  PgO^.^)  and  Pp^.^)  [n3(02t1,0  ) 
and  nr(02jl,03)]  are  computed  if  Z23(02<1,0  ) £ 0 
[Z23(92.,,93)  2 0],  Here  !>3<82l,  ,83),  Pr<92.,.e3>. 

n3^02;1,93^’  nr^02;1,03^  and  Z23^02-r03^  denote  the 
numerical  values  of  p3>  pp,  n3>  np  and  evaluated  at  the 

point  (0  ,0  ).  The  same  computations  are  performed  for  the 

<1*  I J 

point  (02< 2»0  ) . 
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(v)  The  points  obtained  in  step  (iv)  are  plotted  on  the  p^p^ 
and/or  n n„  planes. 

r 3 

(vi)  The  joint  variable  0^  is  incremented  by  A0^  and  steps  (iii)  - 
(iv)  are  repeated  if  0^  < 360°. 

This  algorithm  yields  a set  of  points  (curves  in  general)  which 

lie  inside  the  rectangular  strips  0 £ p^  £ 1 , 0 £ n^  £ 1 in  the  PrP^ 

and  n^n^  planes,  respectively.  If  the  second  and  third  joints  of  the 

manipulator  have  joint  limits,  the  boundaries  of  the  feasible 

rectangular  region  (in  the  0^0^  space)  should  also  be  mapped  into  the 

insides  of  these  strips.  The  totality  of  the  images  thus  obtained  and 

the  lines  p =0,  p = 1,  n =0,  n =1  define  a number  of  regions 
r r r r 

each  of  which  has  an  associated  reachability  number,  r ^ . If  the 
(Pp*P^)  coordinates  of  a given  signed-plane  [the  (n^.n^)  coordinates 
if  Pr  > 1]  belongs  to  a region  with  a reachability  number  r^,  then  the 
wrist  plane  can  reach  that  signed-plane  in  r distinct  ways.  The 
reachability  number  of  a region  R^  in  the  PrP^  plane  is  equal  to  the 
number  of  feasible,  real  q^ ^ = (9^ ,9^,9^)  vectors  which  position  the 
wrist  plane  such  that  its  p-coordinates  are  (/e,0,f).  Here  (e,f)  can 
be  any  point  in  R^.  The  reachability  numbers  of  the  regions  in  the 
n^n^  plane  can  be  similarly  determined  by  performing  the  reverse 
displacement  analysis  (associated  with  the  positioning  of  the  wrist 
plane)  for  a single  point  in  each  region  (see  Section  6.2.2).  It 
should  be  noted  that  the  workspace  of  the  wrist  plane  can  be 
represented  as  the  union  of  a finite  number  of  finite  regions  in  the 


p^p^  and  n^n^  planes.  Such  a representation  may  not  always  be 
possible  if  only  one  of  these  planes  is  utilized. 
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The  regions  in  the  PrP^  and/or  npn^  planes  and  their  respective 
reachabilities  can  be  similarly  determined  for  the  PRRE 
manipulators.  In  this  case  the  wrist  plane  coordinates  are  expressed 

A A A A 

in  the  ( 0^  x2y 2Z2 ^ 3ystem*  Therefore  equations  (6.73) » (6.74)  yield 

p = (1  + Z„)/(1  - Z„),  n = (1  - Z„)/(1  + Z„)  and  the  p„  coordinate 
r 3 3 r 3 3 3 

is  given  by  equation  (6.34). 

The  image  of  HSC^  [under  the  transformation  given  by  the 
coordinate  functions  (6.75)  and  (6.36)]  for  the  RPRE  and  RRPE 
manipulators  can  be  obtained  without  using  the  algorithm  described  via 
the  RRRE  manipulator.  The  stationary  configurations  of  the  RPRE 
robot,  given  by  X =»  0 (see  Table  6.1),  maps  onto  two  vertical  lines 

in  the  PpP^  plane.  The  uncertainty  configurations  given  by  Z ^ = "1 
maps  onto  the  line  p^  = 0 and  the  remaining  uncertainty  configurations 
given  by  Z^  = 0 maps  onto  two  points.  For  the  RRPE  manipulator  the 
images  of  the  stationary  configurations  given  by  = 0 are  two 
vertical  lines. 

The  workspace  (of  the  wrist  point)  of  an  SW  manipulator  can  be 

analyzed  similar  to  the  workspace  (of  the  wrist  plane)  of  a PW 

manipulator.  In  this  case,  however,  the  points  on  the  first  component 

manifold,  HSC^ ^ (see  equations  (5.91)  - (5.98))  and  the  boundaries  of 

the  feasible  region  in  the  q^q^  3Pace  are  mapped  into  the  pz  space  (xy 

Z~2  2 

space  if  the  first  joint  is  prismatic).  Here  p = x + y and  (x,y,z) 
denote  the  coordinates  of  0^  (i.e.,  the  wrist  point)  expressed  in  the 

A A A A 

(O^x^y^z^)  system.  The  reachability  of  each  region  (in  the  pz  plane) 
thus  obtained  is  equal  to  the  number  of  feasible,  real 
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-123  = ^qi,q2,C13^  vectors  which  position  the  wrist  point  such  that  its 
coordinates  are  (e,0,f).  Here  (e,f)  can  be  any  point  in  the  region. 

It  should  be  noted  that  the  method  described  here  for  the  workspace 
analysis  of  the  SW  manipulators  is  much  more  efficient  than  the  one 
described  by  Kohli  and  Spanos  (1984a,  1984b)  which  exploits  the 
discriminants  of  polynomials  and  requires  extensive  amounts  of 
algebraic  manipulation. 

6.3  Upper  Bound  of  the  Number  of  Configurations 
The  number  of  configurations  (NC)  of  a manipulator  was  defined  in 
Section  3-2.  If  this  number  is  high  for  a manipulator,  then: 

(i)  The  workspace  (in  the  POH  space)  will  be  complicated  in 

general.  In  other  words,  it  will  consist  of  many  disjoint 
regions  (with  different  reachabilities)  separated  from  each 
other  by  the  image  of  the  HSC  under  the  foward  displacement 
map. 

(ii)  The  control,  motion  planning  and  rapid  decision  making 

algorithms  will  slow  down  since  they  will  get  complicated. 

In  this  regard  it  is  useful  to  be  able  to  predict  the  upper  bound  of 
the  NC  for  different  types  of  manipulators. 

In  this  section  equations  that  yield  (without  any  lengthy 
calculations)  the  upper  bound  of  the  number  of  configurations  will  be 
developed.  These  equations  are  applicable  for  manipulators  the  HSC's 
of  which  consist  of  component  manifolds  containing  2 or  less  joint 
variables.  For  example,  all  types  of  PW  and  SW  manipulators  satisfy 
this  requirement. 
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A component  manifold  (of  an  HSC)  that  involves  2 joint  variables 
will  be  said  to  be 

(i)  a linear  manifold  if  its  equation  contains  2 linear  joint 
variables, 

(ii)  an  angular  manifold  if  its  equation  contains  2 angular  joint 
variables, 

(iii)  a hybrid  manifold  if  its  equation  contains  a linear  and  an 
angular  joint  variable. 

The  set  of  points  (curves  in  general)  satisfying  the  equations  of 

linear,  angular  and  hybrid  manifolds  in  their  respective  hyperprisms 

(see  Section  3.2)  will  be  designated  by  C , C and  C , respectively. 

j-  cL  n 

The  number  of  regions  due  to  C^,  and  (in  their  respective 
hyperprisras)  will  be  denoted  by  NR(C  ),  NR(C  ) and  NR(C  ). 

-L  3.  fl 

The  equation  of  a linear  manifold  i3  algebraic  in  the  joint 
variables  that  it  contains.  However,  this  is  not  true  for  the  angular 
and  hybrid  manifolds.  The  equations  of  these  2 manifolds  can  be 
transformed  into  algebraic  ones  using  the  identities 

sin  Qt  = 2ti/(1  + tj)  (6.78) 

cos  0.  = (1  - t*)/(1  + tj)  (6.79) 

where  t^  = tan(9V2)  and  0^  denotes  an  angular  joint  variable.  The 
degrees,  or  orders,  of  the  algebraic  equations  thus  obtained  will  be 

D - 2(deg9  + deg0  ) 
a 1 J 


(6.80) 
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for  an  angular  manifold  containing  the  joint  variables  0.  and  0.; 
and 


Dh  = 2(deg0i)  + degSjj 


(6.81) 


Here 


degree  of  the  HSC  in  a joint  variable  (3ee  Section  3.1). 

Let  C* , C’  and  C'  denote  the  set  of  all  points  (curves  in 
1 a h ^ 

general)  which  satisfy  the  algebraic  equations  of  the  linear,  angular 

and  hybrid  manifolds  in  the  S^S.,,  t.t.  and  t.S..  planes, 

ii  Jj  i J i JJ 

respectively.  Furthermore,  let  N , N and  N designate  the  upper 

J.  3.  n 

bounds  of  NR(C  ),  NR(C  ) and  NR(<1).  These  upper  bounds  can  be 
i a n 

determined  using  Theorem  B.1  and  Corollaries  B.2,  B.3  which  are  proved 
in  Appendix  B. 

Determination  of  Nj : The  equation  of  a linear  manifold  is  algebraic 

in  the  joint  variables  that  it  contains.  Hence,  from  Corollary  B.2 


where  n and  b are  the  degree  and  the  number  of  irreducible  factors  of 
the  equation  of  the  manifold. 

Determination  of  N? : Consider  the  hyperprisra  H given  by  the  cartesian 


0.  = (0  • — tt  ^ A tt !•  Thp  hr*anpf*nr'Tnah  1 nn  T wi+*h  hho  naf  a 


Nx  = I(n,b)  = (n2  - n + 2b  + 2)/2 


(6.82) 


product  H = 0^  x 0j  , where  0^^  = {0^  -f  5 < tt}  and 


°j  lwj’ 
functions  t 
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manner  onto  the  affine  t^t ^ plane.  The  boundary  of  H corresponds  to 

the  line  at  infinity,  1^,  of  this  plane.  Under  the  transformation  T 

and  with  the  substitutions  (6.78)  and  (6.79)  the  curve  C is 

a 

transformed  into  an  algebraic  curve,  C' , of  order  D . The  curve  C' 

3 el  SL 

will  be  finite  if  C does  not  cross  the  boundary  of  H.  Furthermore, 

SL 

the  topological  property  NR(C  ) will  be  equal  to  NR(C’)  since  both  T 

SL  SL 

and  T 1 are  continuous.  Hence,  from  Corollary  B.3 


N = F(D  ,b)  = (D  - 3D  + 2b  + 4)/2 

SL  SL  SL  SL 


(6.83) 


where  D is  given  by  equation  (6.80)  and  b is  the  number  of 

a 

irreducible  factors  in  the  equation  of  C* . The  hyperprism  H is 

SL 

topologically  equivalent  to  a torus  and  does  not  have  any  boundary 

curves.  Therefore  the  boundary  of  the  t.t.  plane,  i.e.,  1 , cannot 

i j 00 

serve  as  the  boundary  of  a region  in  H.  Hence  equation  (6.83)  is 

still  valid  even  if  C’  is  a nonfinite  curve,  i.e.,  C crosses  the 

a a 

boundary  of  H. 

The  upper  bound  given  by  equation  (6.83)  cannot  be  achieved  for  a 
special  type  of  angular  manifold  the  trace  of  which  (in  H)  will  be 
designated  by  C . This  special  manifold  consists  of  two  subcomponent 

3d 

manifolds  the  traces  of  which  (in  H)  are  C,  and  . The  equation  of 

1 a 2a 

C is  of  the  form  As.  + Be.  + D = 0 where  A,B,D  are  real  numbers  and 
la  i i 

s^  « sin  0^ , c^  = cos  0^.  Clearly  C^a  consists  of  at  most  2 distinct 

lines  parallel  to  the  0.  axis.  Each  of  these  lines  meets  C at  most 

j 2a 

2deg0j  times  where  deg0^  denotes  the  degree  of  the  angular  manifold 

in  0..  Therefore  the  total  number  of  intersections  of  c and  C 
J la  2a 
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cannot  exceed  4deg0 . . The  number  of  regions  due  to  C will  be 

J as 

maximized  if  the  following  conditions  are  satisfied. 

(i)  The  number  of  regions  due  to  C is  equal  to  the  upper  bound 

d.  u 

given  by  equation  (6.83). 

(ii)  The  subcomponent  manifold  C has  a petal  (see  Appendix  B) 

2a 

which  meets  C in  4deg9.  distinct  points. 

1 a j 

When  these  conditions  are  fulfilled  the  maximum  of  NR(C  ).  denoted 

as 

by  N , will  be  given  by 

clS 


N = (2  + N ) - (1 ) + (4deg0 . - 2) 
as  2a  j 


(6.84) 


where  N„  is  the  upper  bound  of  NR(C^  ) determined  from  (6.83).  Here 
2a  2a 

the  first  2 terms  yield  NR(C  ) provided  that  C and  C are 

33  1 3,  ^3 

nonintersecting.  The  last  term  yields  the  number  of  regions  which 
must  be  added  due  to  the  intersections  according  to  condition  (ii) 
(see  Fig.  6.4).  Equation  (6.84)  simplies  to  yield 


N = N + 4deg0 . - 1 (6.85) 

as  2a  j 

Determination  of  N^:  Consider  the  hyperprism  H given  by  the 

cartesian  product  H = 0^  x where  ^ = {0^  < 0i  < tt}  and 

Sjj  = { S j j : -®  < Sjj  < ®>} . The  transformation  T with  the  coordinate 

functions  t.  = tan(0./2),  = S..  maps  the  inside  of  H in  a 1-1 

i i Jj  JJ 

manner  onto  the  affine  plane.  The  boundary  of  H corresponds  to 

the  1^  of  this  plane.  Under  the  transformation  T and  the 
substitutions  (6.78)  and  (6.79)  the  curve  C.  is  transformed  into  an 
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0^ (rad. ) 


Fig.  6.4 


An  Angular  Manifold  with  N_ 

2a 


5 and  degQ . 

0 


2 


168 


algebraic  curve,  C»  of  order  D,  . The  curve  C’  has  a horizontal 

n n n 

asymptote  (given  by  S..  = cst.)  for  each  simple  intersection  of  C and 

JJ  h 

the  line  0 = -ir.  Such  intersections  of  C'  and  1 do  not  contribute 

j.  n ® 

to  NR(C^)  since  the  lines  0^  = -it  and  0^  = ir  are  considered  to  be  the 
same,  i.e.,  H is  topologically  a cylinder.  The  remaining  inter- 
sections of  C’  and  1 are  due  to  the  vertical  asymptotes  of  C*  which 
n “ h 

are  in  1-1  correspondence  with  the  vertical  asymptotes  of  C . 

h 

Intersections  of  this  sort  do  contribute  to  NR(C^)  in  the  following 

manner.  Consider  an  irreducible  hybrid  manifold  of  degree  n,  the 

equation  of  which  is  + Am_1SJ(j'1)  + ...  + Aq  - 0.  The  number 

of  vertical  asymptotes  of  C^,  u,  is  given  by  the  number  of  real  zeros 

of  Am  which  is  a polynomial  in  t^  Equation  (B.8)  in  the  proof  of 

Theorem  B.1  then  becomes  (P  ) = u + k = n + k - (n  - u) . This 

i max 

modification  reduces  N (given  by  equation  (B.4))  and  hence  I(n,1) 

max 

by  (n  - u),  yielding  I'(n,1)  = (n2  - n + 4)/2  - (n  - u).  Finally 
using  I’(n,1),  instead  of  I(n,1),  for  every  component  curve  of  a 
hybrid  manifold  and  following  the  proof  of  Corollary  B.2  it  can  be 
shown  that 

b 

Nh  = I(Dh*b)  " (Dh  ‘ E V (6-86) 

which  yields 

2 b 

Nh  = (Dh  " 3Dh  + 2b  + 2)/2  + 1 ui  (6-87) 


Here  Dh  is  given  by  equation  (6.81),  b is  the  number  of  irreducible 
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factors  of  and  is  the  number  of  vertical  asymptotes  of  the  i'th 

b 

component  curve.  Note  that  l u.  cannot  exceed  2deg0  . 

i-1  1 i 

A component  manifold  may  only  contain  a single  joint  variable. 

If  this  variable  is  an  angular  one,  say  0 , the  associated  hyperprism 

is  simply  an  interval  of  the  form  0,  £ 0,  £ 0,  + 2tt  where  the  end 

io  l io 

points  are  considered  to  be  the  same.  The  maximum  number  of  regions 
(intervals  in  this  case)  due  to  this  manifold  is  given  by 

Ng  = 2deg0.  (6.88) 

where  deg0^  is  the  degree  of  the  equation  of  the  manifold  in  0^. 

If,  however,  the  manifold  contains  a linear  joint  variable,  say  S^, 
then  the  hyperprism  is  the  interval  -»  < < «.  The  maximum  number 

of  regions  due  to  this  manifold  is 

Ns  - 1 + degSii  (6.89) 

where  degS^  is  the  degree  of  the  equation  of  the  manifold  in  s^. 

The  upper  bounds  of  the  number  of  configurations  of  the  PW  and  SW 
manipulators  can  be  obtained  using  equations  (6.82),  (6.83),  (6.84), 
(6.87),  (6.88)  together  with  (5.80)  - (5.83)  and  (5.91)  - (5.98).  The 
results  are  listed  in  Table  6.2.  The  third  column,  N , gives  the 
upper  bound  of  the  number  of  regions  due  to  the  first  component 
manifold  (HSC  ) which  involves  the  second  and  third  joint 
variables.  Here  it  is  assumed  that  HSC  is  irreducible.  The  number 
of  regions  due  to  the  second  component  manifold  (HSC  ) of  every 
-manipulator  shown  in  this  table  is  2.  Hence  the  upper  bound  of  NC  is 
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Table  6.2  Upper  Bounds  of  the  Number  of  Configurations  for  the  PW  and 
SW  Manipulators 


Class  of  the 
Manipulator 

Types  of  the 
First  3 Joints 

N1 

NC 

DEGU 

E(RRR)-4 

RRR 

12 

24 

8 

PRR 

8 

16 

4 

RPR 

4 

8 

4 

RRP 

2 

4 

4 

S-4 

RRR 

12 

24 

8 

PRR 

12 

24 

8 

RPR 

9 

18 

8 

RRP 

6 

12 

8 

PRP 

4 

8 

4 

RPP 

2 

4 

4 

PPR 

2 

4 

4 

PPP 

1 

2 

2 
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2N^  and  is  listed  in  the  fourth  column.  The  upper  bounds  of  NC  for 
the  last  2 PW  manipulators  and  the  last  3 SW  manipulators  are 
achieved.  This  is  because  the  HSC's  of  these  manipulators  consist  of 
component  manifolds  containing  a single  joint  variable.  It  appears 
that  the  upper  bounds  of  NC  for  the  remaining  manipulators  should  also 
be  attained.  The  last  column  of  Table  6.2  contains  the  degrees  of  the 
manipulators  (see  Section  3.4).  The  degrees  of  the  PW  manipulators 
were  established  in  Section  6.2.2  whereas  the  degrees  of  the  SW 
manipulators  are  due  to  Pieper  (1969).  These  degrees  could  also  be 
determined  by  obtaining  equivalent  1 DOF  spatial  mechanisms  (see 
Duffy,  1980)  and  analyzing  these  single  loop  mechanisms  using  the 
methods  developed  in  the  same  reference. 

The  manipulators  in  Table  6.2  are  listed  such  that  the  upper 
bounds  of  their  NC's  are  in  descending  order.  The  manipulators  at  the 
top  of  each  list  can  potentially  yield  a high  NC/DEG^  ratio  and  should 
be  designed  especially  carefully.  A high  NC/DEG^  ratio  is  undesirable 
because  it  complicates,  and  hence  slows  down,  the  control  and  motion 
planning  algorithms.  Ideally  this  ratio  should  be  1 and  each 
configuration  of  the  manipulator  should  be  mapped  into  the  POH  space 
in  a one-to-one  manner.  The  closed-form  reverse  displacement  analyses 
of  the  PW  manipulators  performed  in  Section  6.2.2,  the  closed-form 
equations  of  the  HSC  obtained  for  the  PW  and  SW  manipulators  in 
Section  5.4  and  equations  (6.82)  - (6.84),  (6.87)  - (6.89)  are  useful 
in  the  kinematic  design  stage  in  this  respect.  Using  these  equations 
it  is  possible  to  predict  (without  any  lengthy  calculations)  the 
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affects  of  the  variations  in  the  dimensions  of  the  manipulator  on  the 

ratio  NC/DEG  . 

u 


CHAPTER  7 

SYMBOLIC  MANIPULATION 

Theorem  2.1  simplifies  the  determination  of  the  HSC-K's 
(K=6,5,...)  extensively.  However,  the  identification  of  these 
hypersurfaces  still  involves  a considerable  amount  of  algebraic 
manipulation  which  includes,  for  instance,  the  formulation  of  the 
PlUcker  coordinates  of  the  screws  (representing  the  instantaneous 
joint  motions)  in  different  coordinate  systems  and  finding  expressions 
for  the  determinants  of  matrices.  These  manipulations  are  extremely 
time-consuming  and  error-prone  when  carried  out  manually.  In  order  to 
remedy  these  problems  a symbolic  manipulation  package  (in  APL)  was 
developed  in  the  summer  of  1984.  This  package  has  been  utilized 
throughout  this  work  for  the  lengthy  manipulations  and  it  can  be  used 
for  the  following  purposes: 

(i)  Determination  of  the  fully  expanded  forms  of  the  P,  Q,  R,  U, 
V,  W,  X,  Y and  Z terms  defined  in  Appendix  A. 

(ii)  Determination  of  any  Jacobian  matrix  [j ^ ] or  [J  ] (for  any 
type  of  manipulator)  in  closed-form. 

(iii)  Determination  of  an  equation  of  the  HSC-K  (for  any  type  of 
manipulator)  in  closed-form  where  K-6,5,.... 

(iv)  Determination  of  the  adjoint  Jacobian  matrix. 

(v)  Implementation  of  the  synthesis  procedure  for  passive  joints 
(see  Section  3.5) . 
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The  developed  package  can  also  be  used  for  general  symbolic 
manipulation  purposes.  A similar  but  more  detailed  package  has  been 
later  developed  by  Reischer  (1986)  which  can  be  referred  to  for  the 
fundamentals  of  symbolic  manipulation. 


CHAPTER  8 
CONCLUSIONS 

The  singularity  structure  of  the  forward  displacement  mapping  has 
been  investigated  in  detail.  This  investigation  has  led  to  various 
novel  concepts  which  have  been  demonstrated  to  be  beneficial  in  the 
kinematic  design  and  analysis,  control,  motion  planning  and 
performance  evaluation  of  serial  manipulators. 

Important  contributions  include 

• An  efficient  methodology  for  the  identification  of  the 
hypersurfaces  HSC-K's  based  on  Theorem  2.1  and  the  minimal 
coordinate  systems.  Existence  of  component  and/or  subcomponent 
manifolds  simplifies  this  methodology  even  further  (see  the 
first  example  in  Section  3.6.1). 

• Theorem  3.1  which  predicts  the  existence  of  passive  joints  and 
component  manifolds. 

• Quantification  of  the  freedom  of  the  end  effector  via  the  hand 
freedom  numbers  which  include  considerations  of  joint 
limitations  and  scale. 

• Theorem  6.1  which  states  that  every  region  CC^  corresponding  to 
the  i'th  configuration  of  an  echelon  manipulator  is  mapped  onto 
its  image  in  a one-to-one  manner  under  the  forward  displacement 
mapping. 
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• Determination  of  the  upper  bounds  for  the  number  of  regions 
formed  by  a linear,  angular  and  hybrid  manifold  via  the  novel 
theorem  and  corollaries  proved  in  Appendix  B. 

Tables  2.1  and  2.2  have  proved  to  be  useful.  It  appears  that  the 
same  tables  could  also  be  beneficial  in  (i)  the  investigation  (via 
screw  theory)  of  the  stationary  and  uncertainty  configurations  of 
single  loop  spatial  mechanisms  and  (ii)  the  theory  developed  by 
Mohamed  (1983)  for  the  analysis  of  the  special  configurations  and 
instantaneous  kinematics  of  the  fully-parallel  robotic  devices. 


APPENDIX  A 

DEFINITIONS  OF  THE  P,  Q,  R,  U,  V,  W,  X,  Y 
AND  Z ELEMENTS 


In  the  following  definitions  e,  f,  g,  h,  i,  j,  k and  1 represent 

any  set  of  successive  integers  in  ascending  order.  Also  sin  9 , 

cos  9 , sin  ct  and  cos  a are  abbreviated  by  s , c , s and  cQ  , 

T p T pY  T T pi  pY 

respectively,  where  B and  Y are  dummy  variables  standing  for  the 
subscripts. 

1.  Definitions  of  Single  Subscripted  Elements: 
a)  Ascending  Subscripts: 


Pi  " °i 


Qi  = Chi3i 


(A . 1 ) 


R.  =*  3 3. 

i hi  i 


Ui  “ "3i 


Vi  = chici 


(A. 2) 


W.  = s..c. 
i hi  i 


X.  = s. ,s. 
i ij  i 


h * ~(3hi°iJ  * Chi3ij°i) 


(A. 3) 


Z1  ■ <0hi°iJ  - 3hi3iJ°i) 


b)  Descending  Subscripts: 


pi  ■ °i 


ut  ■ -3i 


Qi  ■ °u3i 


(A. 4) 


V1  ' °ij°l 


(A. 5) 


B1  ‘ 3lj3I 


Wl  ’ 3lJ°i 
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X.  = S..S. 
i hi  i 


YI  • '<3ij°hi  * 'Vtii'V 


(A. 6) 


zi  ■ (cij°hi  ' 3iJ3hi°i> 


2.  Definitions  of  Multiple  Subscripted  Elements: 


a)  Ascending  Subscripts: 


Efg...jk  GfEg...jk  3fFg...jk 


Ffg...Jk  ' °ef(3fEg...jk  * - 3efGg...jk  (A-7) 


Gfg...jk  3ef ^3fEg. . . jk  + GfEg...jk^  + CefGg...jk 


b)  Descending  Subscripts:* 


Ekj...gf  GkEj...gf  3kFj...gf 


Fkj...gf  = Gkl(3kEj...gf  + °kFj...gf)  " 3klGj...gf  (A,8) 


Gkj...gf  3kl^3kEj . . .gf  + GkFj...gf^  + CklGj...gf 


where  (E  F G)  = (P  Q R) , (U  V W)  or  (X  Y Z)  . 


* If  the  E,  F,  and  G terms  on  the  right  hand  side  of  equation  set 
(A. 82  have  a single  subscript,  they  will  be  replaced  by  e,  F, 
and  G terms  with  the  same  subscript. 


APPENDIX  B 

A THEOREM  AND  TWO  COROLLARIES  ON  THE  NUMBER  OF  REGIONS 
FORMED  BY  AN  ALGEBRAIC  CURVE 

In  this  appendix  a theorem  and  2 corollaries,  regarding  the 
number  of  regions  formed  by  an  algebraic  planar  curve,  will  be 
proved.  Equations  (6.82),  (6.83),  (6.85)  and  (6.87)  (which  lead  to 
the  determination  of  the  upper  bound  of  the  number  of  configurations, 
NC)  are  based  on  these  theorems.  Before  proceeding  it  is  useful  to 
define1  the  following  terms. 

Circuit:  A circuit  is  that  part  of  a real  plane  curve  which  can  be 

traced  by  a continuously  moving  real  point  which  eventually  comes 
back  to  every  point  already  traced.  Here  by  definition  the  points 
of  the  curve  at  infinity  which  are  neighbouring  points  on  any 
projection  of  the  curve  cannot  introduce  any  discontinuities. 
Multiple  point:  A point  P is  called  a multiple  point  of  order  r,  or 

an  r-fold  point,  if  every  line  through  P (excluding  the  tangents) 
meets  the  curve  r times  at  P. 

Number  of  regions:  The  number  of  regions  due  to  a plane  curve  C,^ 

denoted  by  NR(C),  is  the  minimum  number  of  open  connected  sets 

1 The  underlined  terms  are  introduced  by  the  author  whereas  the 
remaining  definitions  are  standard  (for  instance,  see  Primrose, 
1955;  Coolidge,  1959). 

^ The  definition  of  NR(C)  will  still  be'valid  even  if  C consists 
solely  of  isolated  points. 


179 


180 


which  together  with  C cover  the  xy  plane.  The  boundaries  of  these 
sets  consist  of  the  curve  C and/or  the  line  at  infinity,  1 , of 

oo 

the  xy  plane. 

Connecting  and  free  edges:  Let  a be  a node  of  a planar  graph.  This 

node  will  be  said  to  have  e edges  associated  with  it  if  the  graph, 
in  the  immediate  vicinity  of  o,  is  topologically  equivalent  to  a 
point  (the  node)  with  e half  rays  emanating  from  it.  The  two 
edges  that  connect  a node  to  the  two  neighbouring  nodes  on  the 
same  connected  graph  will  be  called  the  connecting  edges.  The 
remaining  edges  associated  with  a are  the  free  edges. 

Leaf : Two  free  edges  associated  with  the  same  node  a must  meet  at  a 

fictitious  node  a.  The  topological  circle  consisting  of  <j,  a and 
the  two  free  edges  is  called  a leaf. 

Petal : The  topological  circle  consisting  of  only  the  nodes  and 

connecting  edges  of  a connected  graph  is  called  a petal. 

Nesting:  The  inside  (outside)  of  a petal  is  the  region  on  the  left 

(right)  of  the  edges  when  a counter  clockwise  direction  is 
assigned  to  the  petal.  The  same  definition  also  applies  to  the 
leaves.  A set  of  petals  and/or  leaves  will  be  said  to  nest  if 
they  are  arranged  such  that  each  is  inside  the  preceding  one. 

A theorem  and  2 corollaries  involving  NR(C)  will  now  be  proved. 

In  the  proofs  of  these  theorems  it  will  be  assumed  that  the  xy  plane, 
on  which  the  curve  C lies,  is  transformed  into  an  ab  plane  using  the 
transformation  f given  by  the  coordinate  functions 
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a = x/( 1 


(B . 1 ) 


b = y/( 1 


(B  .2) 


This  transformation  maps  the  affine  xy  plane  onto  the  open  unit  disk 
2 2 

a + b < 1 in  a 1-1  manner.  The  line  at  infinity  is  represented  by 

the  boundary  of  the  disk,  the  opposite  (or  antipodal)  points  of  which 

are  identified  to  be  the  same  point  for  topological  purposes.  The 

affine  xy  plane  and  the  open  unit  disk  are  homeomorphic  since  f is 

bijective  with  a continuous  inverse.  Therefore  NR(C),  a topological 

property,  remains  invariant  under  the  transformation  f. 

Theorem  B . 1 : Let  C be  an  irreducible  algebraic  plane  curve  of  order 

n.  Then,  NR(C)  £ N where, 

max 

2 n~* 1 

(i)  N - {n^  - 3n  + 6 - [ Z Up(r  - 1)(r  - 2) 

r=3 

n-1 

+ Z V (r)(r  - 1 )]}/2  (B.3) 

r=2 

if  n is  an  even  number  and  the  curve  is  finite, 

2 n-1 

(ii)  Nmav  = (n  - n + 4 - [ E U (r  - 1 ) (r  - 2) 

r= 3 

n-1 

+ Z (V  + W ) (r) (r  - 1)]}/2  (B.4) 

_ o r r 
r=2 

if  the  curve  is  nonfinite. 

Here  U , W and  V denote  the  number  of  real  (finite),  real 
r r r 

(nonfinite)  and  imaginary  r-fold  points  of  the  curve,  respectively. 
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Proof : Assume  that  C has  k real  circuits.  On  each  circuit  identify 

(i)  any  two  ordinary,  i.e.,  1-fold,  points, 

(ii)  the  totality  of  the  real,  finite  r-fold  points  (r  _>  2), 

(iii)  the  totality  of  the  real,  nonfinite  r-fold  points  (r  _>  1) 
as  the  nodes.  Hence,  a planar  graph  consisting  of  k connected  graphs 
will  be  formed  where  the  edges  are  subsets  of  the  curve  C.  Each  node, 
i.e.,  an  r-fold  point,  has  at  most  2r  edges  associated  with  it. 

Because  if  the  contrary  is  assumed  a general  line  intersects  the  curve 
with  multiplicity  m (m  > r)  at  an  r-fold  point,  which  is  a 
contradiction.  Figure  B.1  illustrates  a curve  with  2 circuits, 
AEBB'FDD'A'A  and  GHJJJG,  8 nodes  and  a fictitious  node  J. 

Let  kf  and  k^  designate  the  number  of  finite  and  nonfinite 
circuits  of  the  curve,  respectively.  When  k^  = 0 the  curve  is  finite 
and  the  petals  separate  the  closed  unit  disk  into  P disjoint  regions 


where 


P 


f 


1 + k 


(B.5) 


If  k^  M however,  the  curve  is  nonfinite  and 


P,  £ 1 + w + k - k. 
i l 


(B  .6) 


where 


n 

w = 1 r W 

, r 


(B.7) 


and  P^  is  the  number  of  disjoint  regions  due  to  the  petals.  Now 


suppose  w > n.  Then,  it  follows  that  the  number  of  intersections  of 
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Fig.  B.1  A Planar  Curve  with  2 Circuits 


an  n'th  order  curve  and  1 is  strictly  more  than  n,  which  contradicts 

00 

Bezout's  Theorem  (see  for  example  Primrose,  1955).  Hence  w _<  n and 
equation  (B.6)  yields 


n + k 


(B.8) 


for  w = n and  k^  = 1 . 

Since  the  number  of  leaves  at  a node  corresponding  to  a finite  r- 
fold  point  cannot  exceed  (r  - 1),  the  maximum  number  of  regions 
corresponding  to  the  insides  of  the  leaves  will  be 


L 

max 


n-1 

Z U (r  - 1) 
_ r 


(B.9) 


Thus  for  a finite  and  nonfinite  n'th  order  curve  with  k circuits 


N = P_  + L 
max  f max 


and 


N - (P. ) + L 

max  i max  max 


(B . 10) 


(B . 1 1 ) 


respectively,  which  are  invariant  with  respect  to  any  nesting  between 
the  petals  and/or  leaves. 

According  to  Harnack's  first  theorem  (see  Coolidge,  1959)  an 

irreducible  curve  of  order  n with  r-fold  points  of  orders  s^.s^,... 

cannot  have  more  than  k circuits,  where 

max 
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k 


max 


= 1 + [(n  - 1 ) (n  - 2)  - Es^s.  - 1)]/2 


(B . 1 2) 


Substituting  k = k^^  into  equations  (B.5)  and  (B.8)  and  substituting 
the  results,  along  with  equation  (B.9),  into  (B.10)  and  (B.11),  the 
equations  (B . 3)  and  (B.4)  are  obtained. 

■ 

Let  F(n,b)  designate  an  upper  bound  of  NR(C)  where  C is  a finite 
algebraic  curve  of  order  n consisting  of  b irreducible  component 
curves,  i.e.,  the  equation  of  C consists  of  b irreducible  factors. 
Similarly,  I(n,b)  denotes  an  upper  bound  of  NR(C)  for  a nonfinite  C. 
It  then  follows  from  Theorem  B.1  that 


which  are  essentially  lowest  upper  bounds  since  for  any  n there  exists 
many  nonsingular  and  singular  curves  that  satisfy  Harnack's  First 
Theorem  (see  Theorem  13  in  Chapter  4 and  Harnack’s  Second  Theorem  in 
Coolidge,  1959).  Existence  of  such  curves  is  sufficient  for  the  upper 
bounds  given  by  (B.1 3)  and  (B.1 4)  to  be  attained  (see  the  proof  of 
Theorem  B.1). 

Corollary  B.2:  I(n,b)  = (n2  - n + 2b  + 2)/2  (B.15) 

Proof:  Let  the  nonfinite  reducible  curve  and  its  component  curves  be 

designated  by  C,C. ,C_, . . . ,C.  . These  curves  are  of  orders 
1 2 b 

n,n,  ,n_, . . .rv  , respectively  (n  = n,  + n„  + ...  + nw) . The  number  of 
12b  12  b 

regions  due  to  C,  i.e.,  NR(C),  will  be  maximized  if  the  following 


F (n, 1 ) = (n2  - 3n  + 6)/2 


(B.13) 


I (n, 1 ) = (n2  - n + 4)/2 


(B .1 4) 


conditions  are  satisfied. 
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(i)  Each  component  curve  ( i = 1 ,2, . . . ,b)  is  nonfinite  and 
NR(C  ) = I(n  ,1)  which,  using  equation  (B.14),  yields 

NR(C.)  - (njr  - ni  + 4)/2  (B.16) 

(ii)  Each  pair  of  component  curves,  say  and  C , meet  at  n^n^ 

real,  distinct  and  finite  points  none  of  which  lies  on  a 

finite  petal  of  either  C.  or  C.. 

i J 

Firstly  it  will  be  assumed  that  none  of  the  component  curves  meet  at  a 
finite  point.  Under  this  assumption,  the  number  of  regions  due  to  C 
will  be  given  by 

b 

NR(C)  = [ Z NR(C. )]  - (b  - 1)  (B.17) 

i-1 

Here  the  summation  Z NR(Ci ) yields  NR(C)  when  each  component  curve  is 
assumed  to  be  on  a distinct  plane.  The  number  ( b — 1 ) is  subtracted 
from  this  summation  since  all  of  the  component  curves  are  actually  on 
the  same  plane. 

Consider  now  two  component  curves  and  that  meet  as  stated 

in  condition  (ii).  Let  p.(p.)  denote  a nonfinite  petal  of  C.(C.). 

i J i J 

Each  finite,  distinct  intersection  of  p.  and  p.  introduces  1 region 
which  is  not  counted  in  NR(C)  (see  Fig.  B.2).  Furthermore,  the  number 
of  such  intersections  cannot  exceed  n^n^  according  to  Bezout’s 
Theorem.  Therefore  the  maximum  number  of  unaccounted  for  regions  due 
to  the  intersections  between  C.  and  C.  is  n.n 


It  then  follows  that 
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(c)  Two  Intersections  (d)  Three  Intersections 

Fig.  B.2  Intersections  Between  Petals*  and  pj 


* In  order  to  simplify  the  figure,  the  petals  p^  and  p.  are  chosen 
such  that  they  define  3 regions  when  there  are  zero  intersections . 
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I(n,b)  = NR(C)  + E 


(B. 18) 


where 


E = (ni n2  + + ...  + n^)  + (n^  + + ...  n^) 


* ••• * <%-,%> 


(B . 1 9 ) 


is  the  total  number  of  regions  that  must  be  added  to  NR(C)  due  to  the 
intersections  between  every  pair  of  component  curves.  Equation  (B.15) 
is  obtained  using  equations  ( B . 1 6 ) - ( B . 1 9 ) and  the  identity 


2 2 2 
ni  + n2  + + nb 


(n1  + n2  + .. . + nb)  - 2E 


( B . 20 ) 


Corollary  B.3:  F(n,b)  = (n2  - 3n  + 2b  + M)/2 


(B .21  ) 


Proof;  Let  the  finite  reducible  curve  and  its  component  curves  be 

designed  by  C,C  ,C  , . . . ,C  . These  curves  are  of  orders 
1 2 b 

n,n  ,n2>...,nb,  respectively.  Here  n.n^ ,n2 nb  are  even  numbers 

and  n = n + n„  + ...  + n^ . The  number  of  regions  due  to  C,  i.e., 

1 2 b 

NR(C),  will  be  maximized  if  the  following  conditions  are  satisfied. 

(i)  Each  component  curve  ^ (i=1 ,2, . . . ,b)  is  finite  and 
NR(C  ) » FCn^.l)  which,  using  equation  (B.13),  yields 

NR(C.)  = (n2  - 3ni  + 6)/2  (B .22) 


(ii) 


Every  component  curve  C 

designated  by  c^  ( k= 1 ,2 

c.  and  c.  meet  at  n.n. 
i j i J 


has  a unique  circuit  which  will  be 
,...,b).  Any  pair  of  such  circuits 
real,  distinct  points. 
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When  these  conditions  are  fulfilled 


b 

F(n,b)  = [ l NR(C  )]  - [b  - 1]  + [E  + 1]  - [b] 
i = 1 1 


(B .23) 


where  E is  given  by  equation  (B .19).  The  first  2 terms  of  equation 

(B.23)  yield  the  maximum  value  of  NR(C)  when  no  pairs  of  component 

curves  intersect.  The  third  term  yields  the  number  of  regions  due  to 

the  intersections  between  the  component  curves  according  to  condition 

(ii).  When  this  condition  is  fulfilled  the  circuits  c. ,c_, . . . ,c.  form 

1 2 b 

a single  circuit  with  E leaves  and  one  petal.  This  yields  (E  + 1) 

regions  corresponding  to  each  leaf  and  the  inside  of  the  petal.  The 

fourth  term,  b,  must  be  subtracted  from  the  first  three  because  the  b 

regions  corresponding  to  the  insides  of  the  petals  of  the  circuits 

c , >c_,...,c,  have  already  been  counted  in  the  first  term  of  equation 
1 2 b 

(B.23).  Equation  (B.21)  is  obtained  using  equations  (B.19),  (B.20), 

(B .22)  and  (B.23). 

■ 

The  upper  bounds  I(n,n)  and  F(n,n/2)  given  by  the  Corollaries  B.2 
and  B.3  are  achieved.  This  is  because  there  exists  curves  of  order  n 
satisfying  conditions  (i)  and  (ii)  in  the  proofs  of  these 
corollaries.  It  appears  that  the  remaining  upper  bounds  I(n,b)  and 
F(n,b)  [b=2, 3. • • • » (n  - 1)  and  b-2,3»...»(n  - 2)/2]  should  also  be 
achieved.  Here  it  is  useful  to  note  that  equations  (B.15)  and  (B.21) 
can  be  expressed  in  the  forms 


I (n,b ) = I(n, 1 ) + (b  - 1) 


(B.24) 


F(n,b)  = F(n,1 ) + (b  - 1 ) 


(B.25) 
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